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ABSTRACT 

Two  Extended  Kalman  filter  routines,  one  using  a  one-step 
estimation/prediction  and  the  other  a  sequential  approach, 
were  developed  and  compared  to  provide  real  time  estimates 
of  target  positions  on  the  three  dimensional  underwater  track- 
ing range  at  Naval  Underwater  Weapons  Engineering  Station, 
Keyport,  Washington.   Inputs  to  the  routines  were  acoustic 
pulse  transit  times  from  the  target  to  receiving  array  ele- 
ments which  are  non-linear  functions  of  the  position  coordin- 
ates.  These  inputs  were  linearized  and  the  filter  gains  cal- 
culated on-line.   Simulated  runs  were  conducted  for  tracks  in 
the  area  of  one  hydrophone  array  and  for  tracks  that  transited 
through  multiple  arrays.   It  was  found  that  the  sequential 
estimate  routine  exhibited  better  performance  in  recovering 
from  transients  caused  by  random  measurement  noise  or  target 
movement . 
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I.   INTRODUCTION 

The  Naval  Underwater  Weapons  Engineering  Station,  Keyport, 
Washington  currently  operates  two  three-dimensional  under- 
water tracking  ranges  with  the  capability  of  acoustically 
tracking  torpedoes.   Underwater  tracking  employs  an  acoustic 
device  installed  in  the  object  to  be  tracked.   This  device 
transmits  timed  acoustic  pulses  which  are  received  by  bottom 
mounted  hydrophone  arrays  and  then  relayed  via  cable  to  a 
computer  at  the  observation  site  which  calculates  the  position 
of  the  object  for  each  pulse  and  plots  its  path. 

The  measured  data,  which  is  the  time  elapsed  from  trans- 
mission of  a  pulse  until  its  receipt  at  the  hydrophone  array, 
is  corrupted  by  noise  due  to  the  combined  effects  of  environ- 
mental factors  and  the  measurement  instruments. 

These  noisy  tracks  are  later  analyzed,  and  measurements 
judged  most  inaccurate  on  the  basis  of  total  track  statistics 
are  removed  in  order  to  obtain  a  smooth  representation  of  the 
track . 

As  stated  in  Reference  1,  the  computer  system  at  the 
Dabob  range  of  the  station  will  be  up-graded,  and  will  consist 
of  three  MODCOMP  IV  computers,  by  DATACOM,  Inc.   A  software 
conversion  project  will  take  place  with  applications  software 
being  developed  for  the  new  computers.   The  bulk  of  this 
development  will  consist  of  converting  the  current  tracking 
programs  and  other  related  programs  to  FORTRAN. 


An  opportunity  exists  for  expanding  the  real-time  capa- 
bility of  the  system  by  applying  a  Kalman  filter  routine 
which  can  take  as  an  input  the  transit  times  of  the  acoustic 
pulses,  and  produce  the  best  estimate  of  the  position  of  the 
tracked  object  at  a  particular  time. 


II.   THREE  DIMENSIONAL  RANGE  DESCRIPTION 

The  three  dimensional  range  described  in  Reference  2  is 
an  acoustic  system  capable  of  determining  the  trajectory  of 
suitably  instrumented  underwater  objects  in  the  vicinity  of 
a  transducer  array  placed  at  the  bottom  of  the  bay.   The 
tracked  unit  (torpedo)  carries  a  synchronous  clock  and  an 
acoustic  transducer.   A  hydrophone  array  defines  a  rectan- 
gular coordinate  system  to  which  measurements  are  referred. 
Positional  information  is  obtained  from  the  transit  times  of 
a  periodic  pulsed  acoustic  signal  traveling  from  the  torpedo 
to  four  independent  hydrophones  located  on  each  array.   The 
geometry  of  the  hydrophones  and  the  coordinate- system  is 
illustrated  in  Figure  1.   On  each  array,  the  four  hydrophones 
R  ,  R  ,  R,^  and  R   are  on  four  adjacent  vertices  of  a  cube. 
Each  hydrophone  is  separated  by  a  distance  d=  30  feet  along 
the  edges.   The  origin  of  the  coordinate  system  is  at  the 
center  of  the  cube . 

The  transit  times  of  the  acoustic  pulse  from  the  tracked 
object  to  each  of  the  four  independent  hydrophones  can  be 
expressed  as  follows: 


T   =  1/VEL 


(X+d/2)2  +  (Y+d/2)2  +  (Z+d/2)2 


Tx  =  1/VEL 


(X-d/2)2  +  (Y+d/2)2  +  (Z+d/2)2 


H 


2    AXIS 


SYNCHRONOUS 
CLOCK 


*Y   AXIS 


X  AXIS 


FIGURE  1:  The  Geometry  Used  in  the  Calculation 
of  Positional  Coordinates  (The  origin 
is  at  the  center  of  the  dashed  cube). 


10 


T   =  1/VEL 


(X+d/2)2  +  (Y-d/2)2  +  (Z+d/2)2 


T_  =  1/VEL 

Li 


(X+d/2)2  +  (Y+d/2)2  +  (Z-d/2)2 


h 


Where  VEL  equals  the  velocity  of  propagation  of  sound  in 
water  and  C,  X,  Y  and  Z  are  the  four  hydrophones  on  each  array. 
It  is  essential  as  part  of  this  fundamental  calculation  to 
know  when  the  tracked  object  emits  an  acoustic  pulse  in  order 
to  measure  the  transit  times  to  the  hydrophones.   For  submerged 
objects  two  stable  crystal-controlled  clocks,  one  in  the  track- 
ed unit  and  the  other  at  the  computer  are  used.   Prior  to  a 
run  the  two  clocks  are  synchronized  by  radio. 

The  range  is  a  high  frequency,  short-baseline  facility 
with  the  acoustic  tracking  pulses  emitted  at  7  5  kHz .   The 
range  layout  consists  of  six  in-line  hydrophone  arrays  spaced 
2000  yards  apart. 


11 


III.   THEORY 

In  Reference  3,  a  Kalman  filter  application  was  used 
assuming  a  linear  system  and  filtering  on  the  corrupted  X,  Y 
and  Z  positions  that  the  computer  had  already  calculated  from 
the  received  transit  times  of  the  acoustic  signals. 

A.   THE  EXTENDED  KALMAN  FILTER 

Since  the  transit  times  were  readily  available  and  are  non- 
linear functions  of  position,  these  equations  can  be  linearized 
and  Kalman  filter  theory  applied  using  the  extended  Kalman 
filter.   This  procedure  produces  a  real-time  system,  filtering 
on  the  corrupted  transit  times  T  ,  T  ,  T   and  T  ,  without  the 
necessity  of  converting  these  times  to  positions. 

For  tracking,  a  fifth  order  state  vector  was  chosen: 


I 


X 

X 

X  ■=     Y 

Y 
Z 


The  target  was  assumed  to  maintain  constant  depth  and  any 
velocity  in  the  Z  direction  (Z)  was  considered  a  random  exci- 
tation. 

The  states  were  characterized  by  the  following  difference 
equation: 

X(K+1)  =  $  X  (K)  +  r  W  (K) 
and  the  noisy  measurement  equation: 
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where 


?■  (K)  =  M(X)  +  V(K) 


X(K)    is  the  N-dimensional  state  vector  at  time  K 

W(K)    is  the  M-dimensional  random  forcing  input 
at  time  K 

Z(K)    is  the  J-dimensional  measurement  vector  at 
time  K 

V(K)  is  the  J-dimensional  random  noise  vector  at 
time  K  and  noise  is  assumed  white  and  zero- 
mean  Gaussian 

$  and  r  are  constant  matrices 

M(X)     is  a  matrix  of  the  non-linear  measurement 

equations  which  are  a  function  of  the  states 


The  estimator  equations  are  given  by: 


(K/K)  =  X(K/K-1)  +  G(K) 


Z (K)  -  M(X) *x(k/k-i; 


and 


where 


P(K/K) 


I  -  G(K)H(K)    P(K/K-1) 


X(K/K)   is  the  estimate  of  the  state  at  time  K  given 
K  measurements 

P(K/K)   is  the  covariance  of  estimation  error  matrix 
at  time  K 

G(K)_    is  the  Kalman  filter  gain  at  time  K 

which  is  defined  as: 


-G(K)  =  P(K/K-1)  H(K) 


H(K)P(K/K-1)H(K)   +  R(K) 


-1 


R(K)     is  the  covariance  of  random  measurement  noise 
matrix 

H(K)     is  the  matrix  used  to  linearize  the  non-linear 
measurement  equations.   It  is  defined  as: 
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H(K)  =  2*ff>- 


X(K/K-1) 


X 
The  measurement  equation  matrix  M(~)  is  expanded  in  a 

Taylor  series  and  linearized  around  the  one  step  prediction 

based  on  the  last  estimate .   Only  first  order  terms  are  kept 

The  prediction  equations  are  given  by: 

X(K+1/K)     ■       f>X(K/K)     +    r    W(K) 

P(K+1/K)     =       £P(K/K)<I>T    +    Q(K) 


where 


Q(K)  is  the  covariance  of  random  excitation 
matrix  found  by: 

q(k)  =  r  cov(w)  rT 

and  COV(W)  is  the  covariance  of  the  random 
forcing  input  or  acceleration. 


B.   THE  SEQUENTIAL  EXTENDED  KALMAN  FILTER 

The  prediction  and  estimation  equations  just  mentioned 
represent  a  system  that  is  characterized  by  a  one-step  esti- 
mation and  prediction  for  each  set  of  new  measurements.   Some 
important  points  in  this  one  step  process  must  be  stressed: 

1,  New  estimates  are  only  available  after  the  prediction 
and  estimation  equations  are  calculated. 

2.  A  major  part  of  the  time  period  for  the  estimation 
calculation  is  spent  in  the  gain  equation  because  of 
the  inversion  of  the  (JXJ)  matrix  that  is  required, 
where  J  is  the  number  of  observations. 
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3 .   The  one-step  prediction  and  estimation  for  the  exten- 
ded Kalman  filter  is  based  on  a  linearization  about 
the  predicted  value  over  a  period  t„  to  t   ,  which 
might  be  extended. 
When  the  measurements  come  from  statistically  independent 
sources,  like  the  hydrophones  in  the  torpedo  tracking  pro- 
blem, a  sequential  approach  can  be  taken  to  process  each 
arrival  time  separately. 

If  the  measurements  are  assumed  to  occur  simultaneously, 
they  can  be  processed  one  at  a  time  and  the  result  of  pro- 
cessing one  measurement  component  is  used  in  the  following 
computation  to  process  the  next  measurement  component. 
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IV.   PROBLEM  DEFINITION  -  TORPEDO  TRACKING  WITH  THE 
EXTENDED  KALMAN  FILTER 

In  the  torpedo  tracking  problem,  the  non-linear  observa- 
tions are  the  four  independent  transit  times  from  the  tracked 
object  to  the  hydrophones,  T  ,  T  ,  T   and  T  .   Thus  the  non- 

L-        A        L  Li 

linear  measurement  matrix  M(X)  is  defined  as: 


M(X)  = 


X 


1 
VEL 


VEL 

1 
VEL 

1 
VEL 


2,  ,„..,,„,  2.  ,„.,,„,  2    h 


(X+d/2)  +(Y+d/2)  +(Z+d/2) 


G 


v2~1  h 


(X-d/2)  +(Y+d/2)  +(Z+d/2; 


(X+d/2) 2+(Y-d/2) 2+(Z+d/2^ 


V 


(X+d/2) 2+(Y+d/2) 2+(Z-d/2) 2 


M(X)  is  expanded  into  a  Taylor  series  and  linearly  approximated 
by: 


M(X) 


3M(?) 

SX 


X 


X(K/K-1) 


H(X) 


X 


X(K/K-1) 


The  linearizing  H  matrix  is  evaluated  around  the  best 
information  available  at  the  time  which  is  the  prediction 

IS 

X(K/K-1) ,  and  is  used  in  the  calculation  of  the  gain  G(K)  and 
estimated  covariance  of  error  P(K/K)  equations. 

The  torpedo  dynamics  used  for  the  tracking  problem  are 

2  •  ■ 

assumed  to  be  1/S  with  extimations  on  five  states  X  position, 
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X  velocity,  Y  position,  Y  velocity  and  Z  position  (height  of 
torpedo  above  hydrophone  array) .  The  mean  of  the  random  ex- 
citation is  assumed  to  be  zero 


E(W(K) )=0 


fies  the  estimate  prediction  equation  to: 


X(K+1/K)  =  $  X(K/K) 


,  and  this  simpli- 


Also  the  mean  of  the  random  ncise  is  assumed  to  be  zero 
E(V(K))=0  .   In  forming  the  measurement  equation,  the  best 
guess  of  v(K)  is  used  which  is  the  mean  producing: 

Z(K)  =  M(X) 
Four  measurements  are  taken  every  1.31  seconds,  which  is  one 
time  slot,  and  with  this  sampling  time  the  1/G2  plant  has 
state  transition  (PHI)  and  gamma  matrices  equal  to: 


and 


$   = 


1 

1.31 

0 

0 

0 

0 
0 

1. 

0 

0 

1. 

0 
1.31 

0 
0 

< 

0 

0 

0 

1. 

0 

0 

0 

0 

0 

1. 

N 


r  = 


.86 

0 

0 

.31 

0 

0 

0 

.36 

0 

0 

1.31 

0 

0 

0 

1.31 

^ 


A.   THE  SEQUENTIAL  APPROACH 

In  the  sequential  approach,  the  basic  Kalman  filter  equations 
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have  been  modified  to  circumvent  the  matrix  inversion  in  the 
gain  equation  and  to  obtain  a  more  accurate  estimate.   Calcu- 
lations are  performed  on  each  of  the  four  independent  transit 
times  in  the  following  order  T  ,  T  ,  T   and  T   for  each  1.31 
second  time  slot. 

The  estimate  of  the  states,  X(K/K),  based  on  one  time 
measurement  is  used  as  the  prediction  X(K/K-1)  for  the  calcu- 
lations on  the  next  measurement. 

In  this  manner  only  parts  of  the  linearizing  H  matrix  and 
gain  matrices  are  used  in  each  calculation. 

After  the  linearizing  H  matrix  is  formed  from 

.    H(X)  =  3M(?) 


3X 

X(K/K-1) 

evaluated  around  the  initial  states  X(l/0)  for  K=l,  the  first 
gain  column  corresponding  to  the  first  time  measurement  T^  is 


calculated  from: 


P(K/K-1)H^R0W 
G 


~iC0L       ?iROW?(K/K-1)HxROW+Rii 
where  i  =  1  to  J ,  and  J  is  the  number  of  observations.   In 
the  tracking  problem  J  =  4  corresponding  to  the  four  measured 
times . 

Thus,  the  first  row  of  the  H  matrix  is  used  to  calculate 
the  first  column  of  the  gain  matrix  with  both  corresponding 
to  the  first  measured  time  T^. 
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Next,  an  estimate  of  the  particular  observation  time  M(X) 
is  calculated 


M(X)    = 


"X 


—^      |7x+d/2)2+(Y+d/2)2+(Z+d/2)2 


(X-d/2) 2+(Y+d/2) 2+(Z+d/2) 2 


VEL 


VEL 


VEL 


(X+d/2) 2+(Y-d/2) 2+(Z+d/2) 2 


(X+d/2) 2+(Y+d/2) 2+(Z-d/2)^ 


Using  the  predicted  values  of  X,  Y,  Z  from  X(K/K-1). 

The  difference  between  the  observed  transit  time  Z .  and 

1 

the  estimated  transit  time  T.  forms  the  residual  Z^^^^  which 

x  DIFF 

is  used  in  the  estimate  equation. 


X.  =  X(K/K-1)  +  G.COL 

x      '  1 


DIFF 


This  equation  gives  an  estimate  of  the  states  based  on 
one  measurement. 

Next,  the  covariance  of  estimation  error  is  calculated 
based  on  one  measurement  using: 


P.  s 
X 


I    ~    GiCOLHiROW 


i-1 
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where 

I      equals  the  identity  matrix 

P._,   is  the  theoretical  covariance  of  estimation 
error  from  the  previous  measurement  or  if 
i=l,  the  prediction  P(K/K-1) 

After  the  first  iteration,  X,  becomes  X(K/K-1)  and  P 

becomes  P(K/K-1)  for  the  second  iteration  which  calculates 

the  estimate  of  the  states  based  on  the  second  measurement 

T, 


X 


After  four  iterations  (i=4),  X.  becomes  the  estimate  for 

~4 


the  time  slot,  X(K/K)  and  P.  becomes  the  updated  covariance 
of  error  P(K/K) . 

Then  the  predictions  for  the  next  time  slot  are  calcula- 
ted using: 

X(K+1/K)   =   $  X(K/K) 
and 

P(K+1/K)   =   $  P(K/K)$T   +  Q(K) 

The  entire  process  is  repeated  for  the  next  set  of 
measurements  forming  a  sequential,  extended  Kalman  filter  to 
produce  real  time  estimates  of  the  torpedo  track. 

A  listing  of  the  FORTRAN  program  designed  for  the  se- 
quential extended  Kalman  filter  is  contained  in  Appendix  B, 
The  program  is  in  modular  form  and  well  documented  by  comments 
for  ease  of  implementation.   All  repetitive  calculations  and 
utility  routines  are  separated  into  subroutines  and  are  listed 
in  Appendix  D. 
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B.   THE  MATRIX  INVERSION  APPROACH 

All  results  obtained  using  the  sequential,  extended  Kalman 
filter  were  compared  to  results  from  a  traditional  extended 
Kalman  filter  using  the  equations  delineated  in  the  THEORY 
section.   Thxs  includes  an  inversion  of  a  4x4  matrix  in  the 
gain  equation. 


G(K)  =  P(K/K-1)H(K)T 


-1 


H(K)P(K/K-1)H(K)  +R(K)  I 

The  portion  of  the  equation  to  be  inverted  is  always  symmetric 
and  the  IBM-360  library  subroutine  SINV  was  used  to  perform 
this  operation. 

A  listing  of  the  FORTRAN  program  designed  for  the  tradi- 
tional extended  Kalman  filter  is  contained  in  Appendix  C. 
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V.   TESTING  AND  SIMULATION 

Both  the  sequential  and  traditional  Kalman  filter  routines 
were  tested  first  using  deterministic  tracks  at  speeds  of  5.0 
to  25.0  knots  and  no  measurement  noise  with  a  single  hydrophone 
array.   The  only  errors  allowed  in  the  first  phase  of  testing 
were  in  position  and  velocity  in  the  initialization  of  the 
filter. 

Computer  generated  tracks  were  tested  in  the  first  series 
of  straight  running,  constant  depth  and  constant  velocity 
torpedoes.   A  variety  of  track  scenerios  were  used  transiting 
through  multiple  quadrants  including: 

1.  crossing  north  of  the  array 

2.  crossing  south  of  the  array 

3 .  inbound  to  the  array 

4 .  outbound  from  the  array 

5.  crossing  over  top  of  the  array 

All  runs  were  made  with  a  variety  of  initialization  errors 
in  position  and  velocity. 

In  the  second  series  of  tests,  white,  zero-mean  Gaussian 
noise  was  added  to  corrupt  the  observed  transit  times. 

The  noise  was  added  to  the  straight  running,  constant 
depth  tracks.   Before  this  series  of  tests  could  be  conducted 
a  gating  scheme  was  designed  to  protect  the  filter  from  spurious 
erroneous  time  or  positional  data. 

In  the  third  series  of  tests,  a  number  of  torpedo  maneuvers 
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were  added  to  the  target  tracks.   One-third,  two-thirds  and 
one-G  turns  were  used.   These  tracks  were  tested  with  and  with- 
out noise. 

The  torpedo  velocities  were  increased  to  the  40  to  50  knot 
range  in  the  fourth  series  of  tests  for  straight  running  tracks 
with  and  without  noise  corruption.   Maneuvers  were  then  added 
to  these  higher  velocity  tracks. 

In  the  last  series  of  tests,  the  handoff  routine  described 
at  the  end  of  this  section  was  added  to  the  filters  and  tracks 
that  traversed  through  the  areas  of  multiple  arrays  were 
tested. 

A.   THE  GATING  SCHEME 

The  operation  of  the  filter  may  be  adversely  affected  by 
large  measurement  noise.   One  error  of  a  relatively  large 
magnitude  could  invalidate  the  filtered  output  for  many  sub- 
sequent time  slots.   Before  random  measurement  noise  and  ran- 
dom excitations  could  be  added  to  the  observed  times  for  test- 
ing, a  form  of  protection  was  designed  to  guard  against  cata- 
strophic failure.   This  protection  is  provided  by  establishing 
limits  of  acceptability  for  each  of  the  measurements. 

Measurement  errors  can  occur  because  of  many  factors  in- 
cluding an  error  in  the  transit  time  of  the  acoustic  pulse 
primarily  due  to  the  receipt  of  multipath  signals  from  previous 
time  slots  that  have  bounced  off  the  surface,  bottom  or  dif- 
ferent density  layers,  or  large  errors  in  the  estimates  of 
position  or  velocity. 
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A  three-sigma  gate  was  deisgned  using  the  covariance  of 
measurement  noise  (R)  and  the  covariance  of  estimation  error 
(P(K/K))  . 

For  each  calculation  of  a  state  estimate  (X(K/K)),  the 
largest  positional  covariance  of  error  was  used,  either  X,  Y 
or  Z,  and  converted  to  time  in  seconds  using  the  average  velo- 
city of  sound  in  water  for  Dabob  bay,  4860  ft/sec.   The  gate 
then  was  written  for  each  time  measurement  i  =  1  to  4 : 


/   P(K/K), 

GATE   =     /   dolanrgeSt    +  R-  • 

4860 .  li 


The  gate  expands  or  decreases  depending  on  the  confidence  level 
of  the  transit  time  and  position  estimate.   If  ZDIFF  which  is 
the  difference  between  the  actual  transit  time  received  and 
the  predicted  transit  time  to  a  particular  hydrophone  exceeds 
the  gate,  the  measurement  is  considered  unacceptable  and  the 
filter  gain  is  set  to  zero  causing  the  filter  to  ignore  the 
data  and  take  the  prediction  of  the  states  as  the  estimate. 

X(K/K)  =  X(K/K-1) 

For  the  sequential  extended  Kalman  filter,  because  of  the 
iterative  aspect,  a  large  erroneous  time  measurement  zeros 
only  the  gain  column  for  that  particular  hydrophone  causing 
only  that  hydrophone's  data  to  be  ignored.   In  the  traditional 
one-step  filter,  an  erroneous  input  from  any  hydrophone  zeros 
the  entire  gain  matrix  causing  the  filter  to  ignore  data  for 

the  whole  time  slot. 
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B.   MULTIPLE  ARRAY  TRACKING 

Initial  tests  were  performed  on  tracks  in  the  area  of  one 
array.   In  order  to  more  closely  simulate  a  typical  run  on  the 
range,  a  scheme  was  designed  to  track  a  target  through  multiple 
arrays . 

First,  a  coordinate  system  was  defined  as  shown  in  Figure 
2.   The  center  of  the  coordinate  system  is  geographically  near 
the  entrance  to  Dabob  bay  in  the  simulation.   Array  number  6  is 
the  closest  array  to  the  coordinate  center.   Each  hydrophone 
is  a  particular  array  has  an  X,  Y,  Z  position.   In  the  simu- 
lation array  1  was  at  36,000  feet  from  coordinate  center  and 
array  6  was  6000  feet.   The  C  hydrophone  was  assumed  to  be  the 
axis  location  of  each  array.   Then  each  X  position  for  the  X 
hydrophone  in  each  array  was  X  +30,  each  Y  position  for  the  Y 
hydrophone  was  Y  +30  and  each  Z  position  for  the  Z  hydrophone 
was  Zp+30.  These  72  positions,  an  XYZ  position  for  each  of  4 
hydrophones  in  6  arrays,  were  placed  into  a  6x12  matrix  HYDRO 
and  referenced  throughout  the  routine.   The  geometry  centered 
on  each  array  was  taken  out  of  the  problem  and  the  target 
position  was  based  on  a  central  reference. 

The  non-linear  time  equation  became: 


T  =  1/VEL   /  (X-X0)2+(Y-Y0)2+(Z-ZQ)2 
where  X  ,  YQ  or  Z   is  the  position  of  a  particular  hydrophone 
and  array  being  used.   In  the  filter  routine  X,  Y  and  Z  were 
the  predicted  positions  X(K/K-1) ,  and  the  time  equation  was 
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FIGURE  2 
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used  to  calculate  the  estimate  of  the  measurement  times  M(X) . 
The  decision  parameter  used  to  determine  the  switching  from 
array  to  array  was  a  straight  handoff.   If  the  predicted  X 
position  was  greater  than  3000  feet  from  the  array  in  use, 
then  an  index  (18)  was  incremented  and  the  next  row  of  HYDRO 
was  implemented.   This  placed  into  the  routine  the  X  Y  Z 
positions  of  the  hydrophones  in  the  next  array.   The  handoff 
can  easily  be  utilized  in  real  range  operations,  as  the  tran- 
sit times  from  adjacent  arrays  are  present  at  the  computer  for 
a  particular  time  slot. 

For  simulation,  it  was  assumed  that  in  all  the  arrays  each 
axis  pointed  in  the  same  direction.   In  range  operations,  the 
positions  of  the  particular  hydrophones  referenced  to  the 
central  coordinate  system  can  be  input  into  the  matrix  HYDRO 
to  correct  for  OFF  AXIS  discrepancies. 
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VI.   SIMULATION  RESULTS 

A.   SERIES  ONE 

This  series  of  tests  included  straight  running,  constant 
depth,  constant  velocity  tracks  with  no  noise.   Various  target 
speeds  were  tested  ranging  from  5.0  to  25.0  knots. 

The  only  induced  errors  in  this  series  of  tests  were  in 
initial  target  position  and  velocity.   Both  the  sequential 
and  traditional  filter  routines  effectively  handled  initial 
position  errors  in  the  X  AND/OR  Y  direction  from  0  to  25  feet 
and  initial  velocity  errors  from  0  to  10  ft/sec.   The  filter 
estimate  was  within  3  feet  and  1  ft/sec  in  a  maximum  of  3 
time  slots.   In  a  number  of  worst  case  tests,  initial  posi- 
tion errors  of  up  to  50  feet  and  initial  velocity  errors  of 
60  ft/sec  and  80  ft/sec  were  used.   Both  filter  routines  had 
the  estimate  on  track  within  seven  time  slots. 

Figure  3  is  a  geographical  plot  of  a  typical  series  one 
test  using  the  sequential  extended  Kalman  filter.   The  initiali- 
zation of  the  filter  was  14  feet  off  in  X  and  21  feet  off  in 
Y  with  no  error  in  Z.   For  a  25  knot  target  initial  velocity 
errors  were  3  ft/sec.   Figures  4  through  6  depict  the  devia- 
tion in  feet  between  the  estimated  and  true  positions, 
X  (K)  -  X  (K/K) ,  where  A  =  1,  3  or  5 . 

There  was  no  great  difference  in  performance  between  the 
sequential  and  traditional  filter  routines  in  this  series  of 
tests . 
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B.  SERIES  TWO 

In  the  second  series  of  tests  random  white  Gaussian  noise 
was  added  to  the  transit  time  measurements  for  straight  running 
tracks.   Target  velocities  varied  from  5.0  to  25.0  knots.   Ini- 
tial position  errors  ranged  from  0  to  25  feet  and  initial  velo- 
city errors  from  0  to  10  ft/sec. 

Both  the  sequential  and  traditional  routines  performed 
well  against  the  random  noise.   Estimate  deviations  from  true 
track  in  X  and  Y  positions  were  not  observed  greater  than  3 
feet  after  lock-on  was  acquired.   Figures  7  and  8  depict  the 
estimate  deviation  from  true  track  for  the  sequential  routine. 
Initial  positions  were  9  feet  off  in  X,  13  feet  in  Y  and  2  feet 
in  Z. 

C.  SERIES  THREE 

In  this  series  of  tests  maneuvers  were  added  to  the  torpedo 
tracks  and  the  filter  was  tested  with  and  without  noise. 

Figure  9  is  a  geographical  plot  of  a  25  knot  target  in  a 
noiseless  environment  with  1/3-G  turns  at  time  slots  25  and  65. 
Figure  10  depicts  the  Z  position  versus  the  time  of  run.   In 
the  initialization  of  the  filter  X  was  off  13  feet  and  Y  was 
off  21  feet.   Figure  11  depicts  the  deviation  by  the  estimate 
from  the  true  track  in  the  X  direction,  for  the  traditional 
inversion  approach.   Figure  12  shows  the  deviation  for  the 
same  track  using  the  sequential  extended  Kalman  filter.   When 
the  target  initiated  the  turn  at  time  slots  25  and  65,  the 
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FIGURE  9:  Geographic  Plot  of  a  Track  with  1/3-G 
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36 


J.O  27.50  55.00  5.7.50 

3 10.  co     * 


"srtt  (twn«: 


ncoo 


306.67 


303. 33      * 


Z 
(FT) 

306.00 


t-  +  +  -»■-♦•  +  +  +• 

*  +  +        +++  +  ++        4-  +  +■  *• 


2<9fc.67 


293.33      ► 

* 


290-00 


*  js+.  sa«taft  ^-<«|J(*Hnff*.  +.*-**  ft*  *-*-*<: +T*-***-*;xJ»*V**-*'rr.  <e:{t:ft  ■ft***;**--*  w  *  *  *  *  *  x-»i  ■*':*■»*  f  +  AsatilaV^m  +1-   ' 

0.0  27.50  5S.0O  82-SO  110.00 


IT-SCALE:       '•*<■*    0.138E    01  UNITS 

Y- SCALE:       »♦'"=  0.333S    00  UNITS 

Z  DE"PTH    VS  TIME 


TIME   SLOTS 


FIGURE  10:  Z  Position  versus  Time  for  a  Track  with  1/3-G 
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FIGURE  11:  X  Deviation  from  True  for  a  Track  with  1/3-G 
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FIGURE  12:  X  Deviation  from  True  for  a  Track  with  1/3-G 
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covariance  of  estimation  error  and  thus  the  filter  gains  in- 
creased allowing  more  weight  to  be  placed  on  the  incoming 
data  (transit  times) .   In  thxs  manner  the  filter  was  able  to 
adjust  the  velocities  in  the  X  and  Y  directions  and  force  the 
estimate  back  on  track.   Results  from  both  routines  were  com- 
parable as  is  shown  in  Figures  11  and  12.   The  routine  using 
the  sequential  extended  Kalman  filter  deviated  a  maximum  of 
four  feet  at  the  turn  and  was  back  on  track  within  3  time 
slots,  while  the  traditional  filter  routine  had  a  slightly 
greater  deviation  and  required  2  more  time  slots  to  acquire 
lock  again.   Figure  13  shows  the  deviation  of  the  estimate 
from  true  track  in  the  Y  direction  for  this  same  run  for  the 
sequential  filter  and  Figure  14  for  the  traditional  filter. 
Both  estimates  deviated  a  maximum  of  3  feet  at  the  turn  and 
re-acquired  lock-on  in  4  time  slots  with  the  sequential  rou- 
tine reacting  slightly  better  to  the  turns. 

Next,  target  tracks  with  2/3  and  1-G  turns  were  tested. 
Figure  15  is  a  geographic  plot  of  this  track  with  a  1-G  turn 
at  time  slot  25  and  a  2/3-G  turn  at  time  slot  65.   Figure  16 
depicts  the  Z  position  vs  time  for  this  track.   With  an  ini- 
tialization error  of  13  feet  in  X  and  21  feet  in  Y,  the  maxi- 
mum deviation  after  lock-on  was  again  at  the  turn  points. 
Figure  17  depicts  this  deviation  from  true  track  in  the  X 
direction,  for  the  sequential  routine  with  a  maximum  deviation 
of  approximately  5.5  feet  for  the  1-G  turn.   Lock-on  was  re- 
acquired in  a  maximum  of  4  time  slots.   Figure  18  shows  the 
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FIGURE  13:  Y  Deviation  from  True  for  a  Track  with  1/3-G 
Turns  without  Noise  in  the  Area  of  a  Single 
Array  —  Sequential  Routine 
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FIGURE  14:  Y  Deviation  from  True  for  a  Track  with  1/3-G 
Turns  without  Noise  in  the  Area  of  a  Single 
Array  —  Traditional  Routine 
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FIGURE  15:  Geographic  Plot  for  a  Track  with  2/3-G  and 
1-G  Turns  in  the  Area  of  a  Single  Array 
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FIGURE  16:  Z  Position  versus  Time  for  a  Track  with  2/3-G 
and  1-G  Turns  without  Noise  in  the  Area  of  a 
Single  Array 
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FIGURE  17:  X  Deviation  from  True  for  a  Track  with  2/3-G 
and  1-G  Turns  without  Noise  in  the  Area  of  a 
Single  Array  —  Sequential  Routine 
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FIGURE  18:  Y  Deviation  from  True  for  a  Track  with  2/3-G 
and  1-G  Turns  without  Noise  in  the  Area  of  a 
Single  Array  —  Sequential  Routine 
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deviation  from  true  in  the  Y  direction  with  a  maximum  deviation 
after  lock-on  for  the  1-G  turn  of  under  4  feet.   Runs  with 
the  traditional  extended  Kalman  filter  routine  showed  slightly- 
larger  deviations  with  more  reaction  time  required  to  re-ac- 
quire lock-on. 

In  the  final  tests  for  this  series,  zero  mean,  white  Gau- 
ssian noise  was  added  to  corrupt  the  observed  transit  txmes. 
Figure  19  depicts  the  estimate's  deviation  from  true  track 
in  the  X  direction  using  the  traditional  filter  routine.   The 
target  experienced  1/3-G  turns  at  time  slots  25  and  65.   Figure 

20  shows  the  same  track  in  noise  with  the  same  filter  parame- 
ters when  run  with  the  sequential  extended  Kalman  filter  rou- 
tine.  Comparison  shows  that  the  latter  had  approximately  2 
feet  less  maximum  deviation  and  that  while  the  traditional 
routine  had  trouble  re-acquiring  lock-on  after  the  turn,  the 
sequential  routine  regained  track  within  4  time  slots.   Figures 

21  and  22  depict  the  same  type  of  behavior  for  deviation  in 
the  Y  direction.   Maximum  deviation  again  was  slightly  less  and 
lock-on  more  efficiently  re-acquired  using  the  sequential  rou- 
tine. 

In  the  cases  involving  more  radical  maneuvers,  the  se- 
quential routine  continued  to  perform  better  against  the  mo- 
deled noise.   Figure  23  shows  the  estimate's  deviation  from 
true  track  in  the  X  direction  for  a  run  with  a  1-G  maneuver  at 
time  slot  25  and  a  2/3-G  maneuver  at  time  65  in  noise.   This 
graph  for  the  traditional  routine  shows  maximum  deviation  at 
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FIGURE  19 :  X  Deviation  from  True  for  a  Track  with  1/3-G 
Turns  with  Noise  in  the  Area  of  a  Single 
Array  —  Traditional  Routine 
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FIGURE  20:  X  Deviation  from  True  for  a  Track  with  1/3-G 
Turns  with  Noise  in  the  Area  of  a  Single 
Array  —  Sequential  Routine 
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FIGURE  21:  Y  Deviation  from  True  for  a  Track  with  1/3-G 
Turns  with  Noise  in  the  Area  of  a  Single 
Array  —  Traditional  Routine 
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FIGURE  22:  Y  Deviation  from  True  for  a  Track  with  1/3-G 
Turns  with  Noise  in  the  Area  of  a  Single 
Array  —  Sequential  Routine 


the  1-G  turn  of  approximately  9  feet  and  the  difficulty  the 
filter  had  in  re-acquiring  lock-on.   Figure  24,  which  is  the 
same  track  and  filter  parameters  run  with  the  sequential  rou- 
tine, shows  a  marked  improvement  in  both  maximum  deviation  and 
efficiency  in  re-acquiring  the  track  after  a  turn  in  noise. 

Figures  25  and  ^6  demonstrate  again  the  better  performance 
of  the  sequential  extended  filter  routine  regarding  deviation 
in  the  Y  direction  for  tne  more  radically  maneuvering  tracK. 

D.   SERIES  FOUR 

In  the  fourtn  series  of  tests,  tne  target  speeds  were  in- 
creased to  the  40  to  50  Knot  range  in  order  to  bring  the  simu- 
lation in  line  with  speeds  actually  experienced  on  the  range. 
In  a  noiseless  environment,  both  routines  showed  similar  per- 
formance with  a  maximum  deviation  from  true  track  during  the 
run  under  2  feet.   With  random  noise  added  this  deviation  in- 
creased and  Figure  27  is  a  plot  of  the  deviation  in  the  X 
direction  using  the  traditional  routine.   When  compared  to 
Figure  2  8  which  is  the  same  track  using  the  sequential  routine 
with  the  same  parameters ,  a  marked  improvement  in  maximum  de- 
viation and  lock-on  efficiency  is  noticeable.   Better  perfor- 
mance by  the  sequential  routine  was  also  present  regarding 
deviation  in  the  Y  direction. 

When  ]/3-G  turns  were  introduced,  the  routines  performed 
similarly  in  a  noiseless  environment,   With  random  noise  and 
maneuvers  the  routines  were  again  comparable  with  the  tra- 
ditional routine  performing  slightly  better  as  is  shown  in 
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FIGURE  23:  X  Deviation  from  True  for  a  Track  with  2/3-G 
and  1-G  Turns  with  Noise  in  the  Area  of  a 
Single  Array  --  Traditional  Routine 
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FIGURE  24:  X  Deviation  from  True  for  a  Track  with  2/3-G 
and  1-G  Turns  with  Noise  in  the  Area  of  a 
Single  Array  —  Sequential  Routine 
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FIGURE  25:  Y  Deviation  from  True  for  a  Track  with  2/3-G 
and  1-G  Turns  in  the  Area  of  a  Single  Array 
with  Noise  — Traditional  Routine 
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FIGURE  26:  Y  Deviation  from  True  for  a  Track  with  2/3-G 
and  1-G  Turns  with  Noise  in  the  Area  of  a 
Single  Array  —  Sequential  Routine 
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FIGURE  27:  X  Deviation  from  True  for  a  Straight  Running 
42  Knot  Target  with  Noise  in  the  Area  of  a 
Single  Array  —  Traditional  Routine 
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FIGURE  28:  X  Deviation  from  True  for  a  Straight  Running 
42  Knot  Target  with  Noise  in  the  Area  of  a 
Single  Array  —  Sequential  Routine 


58 


Figures  29  and  30.   Figure  29  depicts  the  estimate's  deviation 
from  true  in  the  X  direction  for  the  traditional  routine  and 
Figure  30  for  the  sequential.   In  this  track  the  target  man- 
euvered, using  1/3-G  turns,  at  time  slots  2  5  and  65.   A 
slightly  better  performance  was  also  exhibited  by  the  tradi- 
tional routine  in  the  Y  direction. 

In  tests  in  which  more  radical  maneuvers  were  made,  the 
traditional  routine  again  exhibited  slightly  better  performance 
in  noise.   Figure  31,  shows  the  deviation  in  the  X  direction  for 
a  track  with  a  1-G  turn  at  time  25  and  a  2/3-G  turn  at  65  using 
the  sequential  routine.   Comparision  with  Figure  32,  which  is 
the  same  track  using  the  traditional  routine,  indicates  that 
the  performances  were  similar  with  the  traditional  routine 
having  a  slight  edge. 

E.   SERIES  FIVE 

In  the  last  series  of  tests,  the  targets  were  tracked 
through  multiple  arrays  using  the  handoff  scheme  described  in 
the  previous  seciton.   Figure  33  is  a  geographic  plot  of  a 
typical  track  including  hydrophone  positions.   Figure  34  de- 
picts the  estimates  deviation  from  true  in  the  X  direction 
using  the  traditional  routine  for  a  straight  running  target  in 
noise.   Figure  35  is  the  X  deviation  for  the  same  track  using 
the  sequential  routine.   Through  the  multiple  arrays,  both 
routines  were  comparable,  and  the  handoff  from  array  to  array 
was  smooth  with  no  glitches.   Figures  36  and  37  also  show  com- 
parable results  for  deviation  in  the  Y  direction  for  this  same 
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FIGURE  29 :  X  Deviation  from  True  for  a  Track  with  1/3-G 
Turns  at  42  Knots  with  Noise  in  the  Area  of  a 
Single  Array  —  Traditional  Routine 
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FIGURE  30 :  X  Deviation  from  True  for  a  Track  with  1/3-G 
Turns  at  42  Knots  with  Noise  in  the  Area  of  a 
Single  Array  —  Sequential  Routine 
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FIGURE  31:  X  Deviation  from  True  for  a  Track  with  2/3-G 
and  1-G  Turns  at  42  Knots  with  Noise  in  the 
Area  of  a  Single  Array  —  Sequential  Routine 
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FIGURE  32:  X  Deviation  from  True  for  a  Track  with  2/3-G 
and  1-G  Turns  at  42  Knots  with  Noise  in  the 
Area  of  a  Single  Array  —  Traditional  Routine 
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Sequential  Routine 


66 


1. 00 


»  i-  ■  n  *  .-   «  .f- 


9-93 


*-54 


•1»2 


i.25.50  250. CC 

*2'3->  «-3'4- 

ARRAYS 


374. 


.111     .  «-?'3  -*  -_"*'zl_>.  ./IE.  ^tV  fi_^ 


4  5 


4^.00 


5' 6- 


3.  IS 

YDEV 
(FT) 

-O-ZS 


-3-64 


-7.04      *•■ 


-10.43 


I.  00 

X-SCAL£: 
Y-SCALE: 


125.50  250.00  374.50  4SS. 


CO 


"**'»     0.622E    01    UW  ITS 

"»■•=  a.33<3£  oo  units 

DEVIATION    FflOH  TRU6    Y 


TIME  SLOTS 


FIGURE  36 :  Y  Deviation  from  True  for  a  Straight  Running 
Track  through  Multiple  Arrays  with  Noise  — 
Traditional  Routine 


67 


11.54 


1.00  125.30  250-00  374.50  'S9.00 

+  ! 


-V2- 

ARRAYS 


-213- 


-3  4 


-4  5 


-5  6- 


7-94 


4-M      ♦ 

YDEV:  • 
(FT)  •    . 

*    . 

* 

0.74      +    .. 


-2.86 


* 
•fc-46     * 


-10.06     * 
1. 


.0  125.50  250. JC  37i.5C 


>?o.0J 


X-SC/aE:       •*"»    0.622F    01    UNITS 

Y- SCALE:        »*i'=    0.3 60E    00    UNITS 
DEVIATION    FftON  1K\JE    \ 


TIME  SLOTS 
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run.   The  target  was  traveling  at  40  knots  and  handoff  was 

accomplished  at  the  following  times : 

Handoff  1  to  2   Time  Slot  77 

Handoff  2  to  3   Time  Slot  168 

Handoff  3  to  4   Time  Slot  260 

Handoff  4  to  5   Time  Slot  352 

Handoff  5  to  6   Time  Slot  443 
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VII.   CONCLUSIONS 

Both  extended  Kalman  filter  routines  designed  will  provide 
on-line,  real  time  estimates  of  targets  with  various  maneuvers 
up  to  1-G  turns . 

Implementation  at  the  range  computer  facilities  can  be 
accomplished  by  loading  the  received  transit  times  into  a  file 
in  memory  and  reading  them  into  the  routine  with  subroutine 
DREAD.   The  hydrophone  positions  can  also  be  read  into  a  file 
to  be  referenced  during  operation.   The  initial  covariance  of 
estimation  error  P(l/0) ,  read  in  as  a  constant  matrix,  can  be 
varied  with  the  uncertainty  of  the  targets  initial  positions 
and  velocities.   Any  greatly  erroneous  time  measurements  caused 
by  multipath  signals  or  from  noise  spikes  will  cause  the  gains 
to  zero,  making  the  estimated  position  equal  to  the  predicted, 
thus  putting  the  filter  in  'coast',  and  preventing  catastrophic 
failure. 

The  system  was  remodeled  to  include  the  X  and  Y  velocities 
in  the  linearizing  matrix  H.   This  model  is  depicted  in  Figure 
38.   With  a  constant  Z,  the  targets  position  at  time  t,  is 
XnYa.   By  the  time  the  transmitted  signal  has  reached  the  hy- 
drophone array,  the  target  with  X  velocity  (Vx)  and  Y  velocity 
(V  )  has  moved  to  the  position  at  t- : 
X  =  X0+VXT 

y  =  Y  +V  T 
0   Y 

where  T  is  the  transit  time  of  the  signal 
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FIGURE  38:  Geometry  used  to  remodel  the  System 
to  include  X  and  Y  Velocities  in  the 
H  Matrix 
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T  =  1/VEL  /  XQ2  +  YQ2 

and  VEL  is  the  velocity  of  propagation  of  sound  in  water. 
Including  the  new  positions  corresponding  to  the  target 

location  when  the  signal  is  received  gives  a  new  equation  for 

the  transit  time. 


T  =  ^j-      /(X-VXT)2  +  (Y-VYT)2 


solving  for  T  produces 


(XVx+YVy)  -  /  (XVx+YVY)2-(Vx2+Vy2-VEL) (X2+Y2+Z2) 

•   (VX2+VY2~VEL) 

Upon  testing,  this  added  complexity  did  not  give  a  correspond- 
ing increase  in  the  quality  of  the  estimate. 

In  general,  both  routines  were  comparable  with  the  se- 
quential filter  having  the  following  advantages : 

1.  Less  deviation  and  quicker  lock-on  time  after  a 
modest  maneuver 

2.  With  the  three-sigma  gate  utilized  a  noise  spike 
encountered  will  negate  data  from  only  that  par- 
ticular hydrophone 

3.  A  matrix  inversion  is  not  necessary. 
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APPENDIX  A 
PROGRAM  DESCRIPTION  AND  FEATURES 

Two  programs  were  written  to  implement  the  extended  Kalman 
filter  routine  for  torpedo  tracking.   The  first,  THEFIV,  uti- 
lizes the  sequential  approach  described  in  section  IV-A,  and 
the  second  a  traditional  matrix  inversion  approach  as  descri- 
bed in  section  IV-B.   Both  routines  use  the  same  utility  pro- 
grams and  are  modularized  for  ease  of  implementation. 

1.   THEFIV  -  Sequential  Routine 

This  program  is  general  in  nature  and  many  of  the 
parameters  of  the  Kalman  routine  are  variable  including: 

a.  The  number  of  states  in  the  routine  -  N 

b.  The  number  of  random  forcing  functions  -  M 

c.  The  number  of  measurements  -  J 

d.  Data  rate  or  sample  time  -  TO 

and  $(1,2),  $(3,4) 

e.  Number  of  time  slots  -  JTIME 

The  constant  matrices  PHI,R,COVW  and  GAMMA  are  read  in  using 
subroutines  in  the  utility  program  AUX.   The  filter  is  ini- 
tialized with  P(l/0)  and  X(l/0)  (initial  covariances  of  esti- 
mation  error  and  states)  also  using  AUX,   The  first  state 
estimate  is  at  time  1  and  continues  until  ITIME  =  JTIME+1, 
True  measurement  times  (ZI)  are  read  in,  four  for  each  time 

slot  (T_,T  ,T„,T  ) ,  using  the  subroutine  DREAD  listed  in  AUX 
C   X   x   Z 

and  corrupted  by  zero-mean,  white  Gaussian  noise  using  the 
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IBM-360  subroutine  SNORM.   For  each  of  the  four  time  measure- 
ments the  corresponding  row  of  the  linearizing  H  matrix  is 
calculated  in  the  utility  subroutine  CHROW,  and  the  corres- 
ponding gain  matrix  column  GI  is  found.   These  row  and  column 
values  are  then  utilized  in  forming  the  covariance  of  exti- 
nction error  for  the  particular  time  measurement  PI.   Next 
the  estimate  of  the  observation  time  M(X)  from  that  particular 
hydrophone  called  ZHAT  is  formed  using  the  subroutine  CZHAT 
and  the  residual  ZDIFF  =  ZI-ZHAT.   Finally,  the  estimate  of 
the  states  XI  based  on  one  time  measurement  is  calculated,  and 
the  process  is  repeated  for  the  next  measurement.   After  four 
iterations ,  XI  becomes  the  state  estimate  and  PI  becomes  the 
updated  covariance  of  estimation  error  PKK,  and  the  predictions 
of  the  states  and  covariances  XKKMl  and  PKKMl  are  formed. 

For  testing,  this  program  used  the  IBM-3  60  library  sub- 
routine PLOTP  to  obtain  plots  of  the  states  and  covariances 
versus  time,  estimate  deviation  from  true  versus  time  and  a 
geographic  track. 

2.   THESIS  -  Traditional  Routine 

THESIS  utilized  the  same  format  as  THEFIV.   The  para- 
meters N,M,JS,  sample  time  and  number  of  time  slots  were  still 
variable,  and  the  filter  initial  conditions  and  constant 
matrices  were  read  in  by  the  subroutines  located  in  AUX.   True 
time  measurements  were  again  read  in  for  each  time  slot  through 
DREAD  and  corrupted  with  noise  from  SNORM.   The  linearizing  H 
matrix  was  formed  row  by  row  using  subroutine  CHROW  and  used 
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to  calculate  the  gain  matrix  G.   The  symmetric  matrix  inver- 
sion in  the  gain  equation  was  done  by  the  IBM-360  library 
subroutine  SINV.   The  estimate  vector  of  the  observations 
ZHAT  is  formed  iteratively  by  CZHAT  and  used  to  calculate  the 
residual  vector  ZDIFF.   Next  the  estimate  XKK  and  updated  co- 
variance  of  error  matrix  PKK  is  calculated  once  for  each  time 
slot.   Finally,  the  predictions  XKKMl  and  PKKMl  are  formed 
before  the  process  is  repeated  for  the  next  time  slot.   PLOTP 
was  again  utilized  for  the  output  graphs . 
3.   Utility  Programs 

These  subroutines  were  designed  to  be  used  for  re- 
petitive calculations  and  processes.   The  first,  AUX  performs 
all  data  input  functions  and  matrix  manipulations  including: 

a.  PROD  -  multiplying  two  matrices 

b.  MMULT  -  multiplying  a  matrix  and  a  vector 

c.  VMULT  -  multiplying  two  vectors 

d.  MREAD  -  reading  in  a  matrix 

e.  TRANS  -  transposing  a  matrix 

f.  ADD  -  adding  two  matrices 

g.  VREAD  -  reading  in  a  vector 

h.   DREAD  -  reads  in  a  matrix  containing  observed 
time  data 

i.   TRREAD  -  reads  in  a  matrix  containing  true  posi- 
tional data  for  comparison 

The  second  utility  subroutine  CZHAT  calculates  the  esti- 
mate of  the  observation  times  (TC,TX,T   or  T^)    using  the 
predicted  state  values  (X'(K/K-1)  )  . 
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The  subroutine  CHROW  calculates  a  row  of  the  lineariz- 
ing H  matrix,  each  row  corresponding  to  a  particular  observa- 
tion time  measurement. 


A.   VARYING  STATE  TRANSITION  MATRIX 

2 
In  the  1/S   model  that  represents  the  dynamics  of  the 

Kalman  filter,  the  State  Transition  and  GAMMA  matrices  are  as 

follows: 
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where  T  is  the  sampling  time.   In  the  tracking  problem,  this 
time  is  not  always  constant.   As  is  shown  in  Figure  39  it 
varies  with  the  transit  times  required  from  positions  in 
adjacent  time  slots.   In  Figure  39,  the  target  is  at  position 
1  at  arbitrary  time  t  ,  and  is  at  position  2,  the  next  time 
slot,  at  t  +T  where  T  is  the  time  between  pings  of  the  target 
transducer  =  1.31  seconds.   The  times  that  the  transmitted 


76 


Y 


POSIT    1 


T, 


/ 


0   / 

/ 
/ 
/ 

/    / 

/ 


T- 


/ 


/ 


/ 


POSIT   2 


/ 


t0+T 


/ 


7- 


T, 


X 


Moving  Target  in  the  X-Y  Plane 

Ts  =  (t0  +  T  +  t2)  -  (to  +  ti) 
Ts  =  T  +  (t2  -  ti) 
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signals  are  received  by  the  hydrophone  array  are: 
Time  signal  received  from  position  1  =  t.+t.. 
Time  signal  received  from  position  2  =  tn+T+t~ 

where  t,  and  t_  are  the  transit  times  from  position  1 
and  position  2  respectively.   The  difference  between  these  two 
times  signals  are  received  is  the  sampling  time  T  . 

Ts  =  (V^V  -  (to+ti} 
Ts  =  T  +  (Vti) 

Therefore,  the  sampling  time  differs  each  time  slot  from  the 
clocked  ping  time  by  the  difference  in  the  adjacent  slot 
transit  times . 

In  the  programs  THEFIV  and  THESIS,  this  difference 
is  calculated  using  the  average  measured  times  from  the  four 
hydrophones  for  each  time  slot. 

B.   ADAPTIVE  Q 

The  Q  matrix  which  appears  in  the  predicted  covariance  of 
error  equation 

P(K+1/K)  =  $P(K/K)$T+Q(K) 

and  is  formed  by 

q(k)  =  rcovwrT 

is  a  measure  of  the  amount  of  target  maneuverability  that  can 
be  handled  by  the  filter.   If  more  random  excitations  (or 
accelerations)  by  the  target  is  expected,  Q  is  increased  which 

78 


in  turn  increases  the  covariances  of  estimation  error  P(K+1/K) 
and  the  filter  gains  G.   Corresponding  the  filter  puts  more 
emphasis  on  the  incoming  data  and  is  better  able  to  see  and 
react  to  target  turns.   However,  if  the  filter  gains  are  in- 
creased the  filter 'bandwidth  is  widened,  which  lets  in  more 
noise,  and  makes  the  filter  more  susceptible  to  error.   The 
adaptive  Q  routine  (Reference  4)  varies  the  Q  matrix  as  the 
velocities  in  the  X  and  Y  directions  are  increased  or  de- 
creased.  This  routine  was  implemented  in  the  subroutine  QFIND 
with  inputs  of: 

SIGACC  =  expected  maximum  acceleration  in  the  X  or  Y 
direction  in  ft/sec 

SIGDIV  =  expected  maximum  acceleration  in  the  Z  direction 
in  ft/sec 

SIGCC   =  expected  maximum  target  course  change  in  degrees/ 
sec 

QFIND  is  listed  in  Appendix  D. 
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APPENDIX    B 
SEQUENTIAL    EXTENDED   KALMAN    FILTER 
THEFIV 


oooooooo 
»-<i  cm  m  <*■  in  •£>  r-  oo 
oooooooo 
oooooooo 
oooooooo 

LULULULUU'LULULL1 

iiiinn 

l-t-|-^t-t-Ht- 


oooooooooooooo  ooo  ooo  ooooooooooooooooo 

cr>o«-)<\im«frmvOf^oooxo»-4>fr  oi^od  o,-i<\i  sfu^vor-coo*o,.-]{vjcn>i-cf\<)r-cea>o 

0<p-4<-49-4*->v!7-4t-<lr-9r-4l-<'C\|CMCM  CMC\I«M  COcOC**  mC"l(f|I<tO)m^>OvO,C>0>0'0'0>0'Or- 

oooooooooooooo  ooo  ooo  ooooooooooooooooo 

oooooooooooooo  ooo  ooo  ooooooooooooooooo 

LUluLUlULULULUluLULUlULULULU  LULULU  LULULU  LULULUUUWLUlL'UjlULULUlULULUujLULU 

iniiiiiiinii  hi  in  iiiiiiiniiiinii 

l-K(-hl-l-l-l-l-l-|-K(-l-  Ht-»-  • —  I — ■ —  I — 1 — I — 1 — I —  1 —  I — I —  I —  f— I — t —  I — 1 —  1 — I —  I — 


__!«•»  x  -ir\ 

i—  ir\m  ..— ^, 
ww  ~— f^jm 
Xi-irnifN— u. 
o_x— '  »-cnu_ 

— —  >  ►  -a 
unmoo— x— 

mm  HO"*'* •— 

«—»» , •CNJOOJ 

^Q.io.-iO.mM 

—^2:  »o.  ••m  »• 
mcLUJin  — — —- — 

-"—■I -NH^ 

^ICOO-U.- 
i<£0_  •»  ••^g-lu.CO 
X   ►— — inO"-";*. 

.— ir\in—  t$  ► 
— <r  •»  •o-^x— 
m  »tr>rnuJrn  »"*' 

*"fr > 

— '0£X)<   •+-  <-<X 

ii  «qx-  ••**>  •■ 
:*£-•  Q-3TO~  «— • 

Q-ff|   ►<j-SOIT\CM 

«»  •— .om«-*>— ,-* 
— mm  t-~ina.  •» 
m~  •— » t_^x>o 

•"^in-frz^  •— ■ 

■^XMi-iCccrMce: 
^<Q-i»j^I — o 

so  *  •<  •**->- 

*  ■ — —  ~~ox 
^—mm— o  »  •■ 
a.  m~-"- -o»-4'-'— 

«~»-tX— 'l-^>OfJ 
p)X   •»ir>*£a;    p.  *■ 

SO.— 'Dl — 

5£      ITihO   ••(VJO 

:*z  "o^:^— ^ 
xom  «•  t»ointn 

zooa-inoin  »-m 
ozs-  ^—- ~u- 
jru-iujsinxrvju. 

a-**:ztr\a:-fra  n  ii 
oaa.oxi-ox 


CO 

LU 

co 

o 

Q. 

— 

CO 

<_> 

CM 

z 

o 

r-J 

< 

o 

f* 

a: 

-^ 

1— 1 

i-4 

»- 

1- 

00 

II 

<x 

■» 

-5 

>- 

s: 

> 

• 

t» 

LU 

sr— 

i—i 

o 

0m* 

O 

<i- 

«-»**■» 

o 

flO 

—i 

1 

Ow 

(SJi-i 

o 

-4 

** 

«- 

co 

-X 

1  1 

M 

^ 

C- 1 

z 

LU 

2:2:2:0. 

Q. 

rnro 

CO 

CT> 

*-^ 

^» 

•» 

o 

^»—  »•»«»« 

c 

MM 

•* 

in 

O 

z 

z 

c-l 

ZcoSZZZ 

c 

LU 

*  * 

o 

>-< 

QC 

*> 

•h 

cc 

•—J  •»••••> 

_l 

z 

com 

LU      O 

>fr 

o 

«-l 

•-4 

\- 

Z   ^3<<Z 

CM 

•»  •" 

z    < 

9-4 

>— 

s 

2- 

< 

«K>o>2:y  ». 

1— 

H- 

00  <o 

«    to« 

•—    • 

X^i 

^ 

!«i 

3T 

m^SIh 

0 

t— i 

—* •— 1 

t-    i-ic\jm 

— •    • 

id 

ii 

x  •o<r<x 

-J 

!-4 

** 

J-— — 

-5      CO 

•*>0  — O 

X 

Q- 

t— 

Q-a:~oo"- 

CO 

+ 

--* 

►00 

—    —a-o 

»CMJL 

«^ 

'"■-*' 

Z 

'■!-,      m                ^*^'W 

LU 

•  11  -^cta: 

o-»„_jU.o.-jmc\j 

o 

o 

< 

OOQOcoco 

LU 

2: 

Oi£  II  00 

ocoomo  ii  r«-,_j 

< 

< 

h- 

««Z2 

S- 

>-i    • 

Oi(i<r|>> 

CM*"*tM- 

— 1— 4  c- 1     •»— • 

~~ 

LU 

»™ 

LU 

co 

LULUUJLU<< 

NH 

f-OO 

ill 

r-4    •""■»    M— CO 

r~-i- 

s-1 

OC 

c-4 

a: 

Z 

QCaiQiQifltQ: 

1— 

-jOrOCJi 

11  11 

rnm)_m<  H  o>^< 

I 

> 

1 

3: 

O 

2: 2: 2:2:1- 1- 

II  0 

1  c*a— — 

•-<-SOO>QS 

■V 

»■* 

o 

LU 

LUvOr— 

orom 

«!■*-)  t-ia2:Qa:oi,^<ac 

o 

—1 

o 

—i 

1 1 — 1 — I 1 — 1 

X 

SrOXOvO1-"-1 

II    ||   II  <(X<cO 

UJO 

«v 

—1 

— • 

-i 

z 

JJJJJ-J 

1— 

1— 1  II 

11  0 

w»— 

wajotuouJiLi-ioaH' 

X 

< 

u. 

<i 

H^ 

<<1<1<<<I 

h-l-3 

□  CD  CO 

T-*t-o:u.ct: 

ooO 

o 

o 

000000 

I- 

•-•X 

co 

3X> 

o 

o 

o 

cc 

t-t 

OsQy 

< 

< 

< 

< 

O 

3 

u^tn 

c 

o 

LU 

h- 

o 

N 

r-*>- 

_l 

-1 

■tv 

Qi 

CO 

CM 

o 

^ 

o 

^ 

O 

000 

\ 

^s 

80 


THEFIV  (con't) 

oooooooooooooooooooooo  OOOOO  OOOOOOOOO  OOOOOOO 

•-scMfo^tn^or-ooo^o^KMrn^irivof^occro^icvi  fo«*iri-or—  o^^tvjm^mvOf-oo  s-gc\i<n-i"if>>of~- 

r>r»Nr-r-i^N«o<Do>oxo>o»o><ro>o,oNo>ooo  ooooo  ^}r-a^t-<T--'«-i*-<*-*'->  cmcmcm^cmcmcm 

OOOOOOOOOOOOOOOOOOOt-),-j,-j  i-a^«-J,_j»-4  e-a^,_j.-ir-i.-i»-'!i-)»-<  ,_j,-i^«i-J,-i»-ii--i 

OOOOOOOOOOOOOOOOOOOOOO  OOOOO  OOOOOOOOO  OOOOOOO 

tlJUJLUUjmujLUuJUJUJllJUJUJUJ^UJIJjLUUJUjU-IUJ  UJluu;LUUJ  ujU-'UJ  LULU  LULL 'LULU  UJujU-;lljLLJujlL' 

iiiiiniiniiiiiiiiiir  mii  iininn  innii 

t-f-l-l-l-HKI-l-t-H-l-t-KI-t-l-l-t-J-t-t-  I — • — I — I — I —  l-hl-l-l-H-l-t-t-  I — t —  I —  I — t — I —  I — 


ro 


X 

CM 


LU 


X 

LL 

N* 

o 

h- 

LUI- 

a. 

r- 

O 

-> 

< 

Za: 
<o 

— a. 

CJ5 

t— « 

O.H- 

x 

oc> 

"J'— 

p— < 

<f- 

~x 

^ 

>  •» 

23 

o 

H- ( 

ox 

OO 

< 

X 

Ol- 

QCQ- 

at 

Q. 

•»   •» 

-^ 

X  + 

t- 

X 

*^ 

OCL 

Ql 

*    • 

00 

HI 

«4- 

<t  1 

-2Z 

—  II 

t- 

Oi 

XI- 

cqOlu 

1 

0.— 

cc 

1- 

to* 

wZ 

r-J  *t— 

H-Q. 

< 

< 

l»J 

l-LU 

•ZQ 

T. 

QCt 

w-5 

I- 

x 

+ 

O0S 

CO  *o 

O 

O 

H^      «• 

O 

oo 

— . 

LULU 

>z  » 

y 

a. 

oa 

ft 

■§ 

x 

m 

►«: 

-  -2 

LU 

oc 

*►-. 

vO 

•» 

o 

«# 

2X> 

CQ3    ► 

o 

2LU 

•*.* 

CM 

►— # 

*^ 

~«o0 

xos- 

C3 

X 

=^x 

c 

M 

h- 

M 

« 

*CCX)i-« 

>v 

OU. 

1  o 

(- 

■» 

•— i 

+ 

U>LU 

3IZ   « 

•> 

_lO 

wQ 

X 

00 

_ 

X 

a  ••o— • 

X 

a 

Z  H  Q. 

mo 

CM 

2 

CM 

LU 

Qis-J   *— 

M 

OLU 

»  ^  »■■ 

hO 

» 

—» 

< 

w*      — 

*•» 

l-LU 

IZ^ciZ- 

o 

■-JO-Q. 

*  — 

• 

oo 

00 

QC 

*m        «■*       *••"■ 

£ 

<x 

•.*iO  + 

►z 

ZZ 

X  II  -5-3 

mjc 

*>- 

LU 

-5 

1— 

M       1— —CM  CM 

V> 

_!—, 

oo  i— «i^ct:cL^s3 

— < 

«^}_    •   • 

•V) 

*:< 

x 

•* 

+  <M  1  CM   »  •■ 

O  —  -H— 

Xt- 

T-au 

II  z 

<H- 

HlQ-O 

CO   • 

•■a: 

i— ♦ 

H* 

LU 

—  1—  CM    -r*—i 

t— «-ic\irO 

o 

»<r»w_LUXO 

oorr 

||        -*LULU 

"-•i- 

CO  a: 

i- 

txl 

t- 

r-»  II  H-t-»—  — • 

■w  ^EW^, 

-ILU 

H3Ht-i->-<  II 

< 

Cl&~    »OLU 

^o 

_< 

■■» 

< 

— _)— . »•-•.-• 

QQDQ 

<2 

II  O-l-lO 

"~ • 

i-> 

wf>-xaz3 

QJ    • 

M« 

LU 

o 

h- 

~i»-  1  h-.-1-X 

•^ 

«I(-t-K 

uo 

waj^Uvox 

ooc 

X<->«3 

QC  — 

a*  •  •  • 

X> 

< 

00 

fsi— OXQ-Q- 

CM 

LU  II    II    II 

l 

xxs:  ii  ,_)*-> 

QCO 

^-OQ«~l—  "h 

Q»H 

irvxoo 

a: 

LU 

— •— ii —  a.  n  ii 

*• 

ct.  ~  —  — 

22 

^s>s 

w 

M 

f-oo-u-zt- 

>- - 

r-^oo 

1- 

CC 

LU 

■*   •  ii  ii  ~— 

9-i 

CL-^.^.-^. 

□O 

O              OOh 

LLLU 

i-hOX 

Xt-* 

f-OO 

a 

X 

—  o^—f-4ro 

•* 

i-^^^: 

Q£ 

JJJZOO 

X 

o          oo 

It  5"HvOl-'0'J3 

LU 

\— 

muuoKj*  »  » 

H-* 

■  n.«.i._ 

IQ 

n_i-J_iuj 

LU»- 

Q                    O 

—  ^4 

— <  1  1 

X 

-j 

CM    •   ••  *CM-4"CMX 

_!X>rM 

LU 

Q«<Q 

X 

ro^ociuxst— 

t- 

_i 

> 

•  ^  b-S  CO  "-"—(— Q- 

JD3D 

t-t/> 

U<->u><3 

KLU 

— iXh|-  GicOX 

< 

a: 

-^--ht-  II 

II 

<oca:a: 

LU< 

}- 

-_,-»_-     || 

hO    II     II 

LU 

o 

< 

cjt— »— 1— 

OCE 

00 -J 

mmaoa:u.-*>- 

(— 

> 

INULIIXII-H 

— I_l 

tvl'-''— 13      oOX 

X> 

»— "1Q.Q.CLQ. 

< 

h-CC 

X 

Q. 

LU 

ooo 

00O 

x 

X 

a:  a: 

►1_J 

o 

CT» 

a 

o 

l-H 

—IOC 

9+ 

X< 

O 

m 

o 

w-< 

1- 

LLLU 

»H 

s0 

t-o 

cj\r~- 

-o 

r- 

>o 

P- 

<p4 

i-r- 

o«_>o    ooo  oo  oo 


81 


THEFIV    (con't) 


oo 

ooo 

oooooo 

O 

oooooo 

co-4- 

<or-m 

vor^oocr  o»-i 

<• 

xor-oocr*o,-« 

cmco 

«\€U<t 

>4-sj->j-*i-iriiri 

in 

irMr\inir>^sO 

f-4f4 

r-4r<wt 

!— I»— I»-f3»— )t—J»-<l 

t-< 

•— j^-l»— )•— 3  •"*!-« 

oo 

ooo 

QOOOOO 

o 

oooooo 

UJUJ 

LUUJt-U 

LU  LU  LU  UJ  (XI LU 

UJ 

UJUJ  UJUJ  UJUJ 

XX 

III 

IIIIH 

X 

IIIHI 

t-t- 

Kt-(- 

1-hl-t-l-H 

H 

1 — 1 — 1 —  t-^l — ( — 

ooooooooooooo 
m  >*■  it\  oo  cr*  o  ^  <"•  i  rn  <nn  op  o* 

vOvOvO0000O>Ov0>1CT1O^Ov(J>»J> 

i— V^t— 3«— ]«— J>-1,— i^f^i— )»— 1r-1i— 1 

ooooooooooooo 

LU  UJ  UJ  UJ  UJ  LLI  LU  UJ  LLI  UJ  UJ  UJ  LU 

niiiiiiiini 


ooooooo 

x-tLOvOfo-OOCTO 
OOOOOOoj 
C\lW<M(\JC\J<Mc\l 

ooooooo 

LU  LU  LU  UJ  LU  LU  LU 

Illllll 


X 

■— » 

Z< 

«t 

(- 

LULU 

Ml 

z 

2 

*• 
LU 

LU 

LU 

►a 

z 

.-scorn 

s. 

(X 

X 

a 

*:*:*: 

M 1 

-D 

cc  ii  o 

►— i 

CLO-O- 

1- 

on 

u. 

LU^jiLU 

*-» 

i— 

II    II    II 

< 

u_ 

l-^H- 

H^ 

o 

O.Q-Q. 

a 

LU 

t"^  . 

U_^l< 

Q- 

M» 

«-.—■-«. 

LU 

X 

o 

— . 

<^o 

*•> 

o 

— . 

—  "~  — 

O 

IVJ 

o 

xa 

z 

LU 

03 

tninm 

UJ 

LU 

* 

"J 

a    s 

« 

oc 

l>sl 

*ii«£i*: 

LU 

z 

— 

|k 

LUZ 

z 

Q. 

•» 

Q.O.O. 

O 

a 

rvl 

o 

l-LU«-« 

m 

co 

•   •   • 

X 

NH 

i-m 

<xsr 

z 

1— 

>- 

UjLULU 

LU 

z 

M> 

i ■ 

Ql-^ 

#* 

z 

•> 

OOo 

o 

a 

•-• 

M 

o.     ^ 

— 

.-* 

LU 

co 

•  •  • 

— o 

Z 

o 

o. 

x  ••x,-< 

o 

X 

X 

X 

t-*rr»in 

ujin 

LU 

□ 

+ 

II 

>— i       Q. 

~5 

*i 

LU 

*> 

^idii 

-»l- 

LU 

LU 

— • 

»-» 

^ 

►Xa.  ii 

*» 

*: 

cc 

h- 

0.0.0. 

-~<Q 

CO 

00 

IVJ 

o 

o 

zo 

?~i        UJ^ 

a 

a 

x 

< 

».'i»i« 

— Ol- 

< 

►—« 

in 

1— 1 

•—5 

2hl-^ 

»^ 

•* 

to 

5 

•    •   • 

"■"•or 

00 

<n^*~ 

wZ 

»-)    •> 

^i—U_Q. 

M« 

s. 

< 

QOq 

*+o 

< 

M-4 

cz 

!i— i   «» 

II  O 

^       < 

»— * 

X 

LU 

n- 

zzz 

i— »LUO 

X 

lu^js: 

1-    -X,-! 

Om. 

XQ     O 

•"• 

ZQ- 

a 

S 

•-■<: 

<« 

w| 

t-  ii  *: 

#-( 

I  II    H 

-JwLU 

LU    -Z 

o 

oll 

Q. 

wX 

CC<LU 

LU 

«trvji^ 

a  it 

—o 

•-•X 

oo_jz:< 

z 

1-^ 

r-»»« 

— 

1— 

(<>M 

■—  »~  — ,  ^-  .—  „ 

— Ot- 

1— 

JiiX 

(^CSO*-1 

002-Z 

<_i— 

»■ 

•-» 

II  o 

00 

»-  1 

^fOLOCO^^i 

ooo_<^;<r 

mi 

II 

'"•il^ 

IIM 

Ml^'-'IU 

3«w 

s-4 

•-^ 

o-? 

O 

a: 

<o 

•»  •»  ~ic^ic 

•  CO-O^OZ 

i_r — 

•*■ 

— m 

^l-X 

O^X 

II 

X-5    •■ 

o 

»— 1 

IH 

t-«mina_o.a.o<ri—  •• 

-»<•      «* 

O0«-Jf»«l 

* 

HNOaZZ 

—      <X  II 

a 

II 

OLU 

cc 

U_ 

MM 

—»«-">~   •    •   »<0»»Oi|-s>)  •»"i 

LU 

I-* 

ocrs: 

O      Om 

»-jo    ><: 

m 

0- 

00— <x 

o. 

o" 

»-*i-i>-iUJUJLUC0h-CT_lO»    II  O 

o~ 

LU^^O 

Ol- 

1  zz* 

QLTI— Z 

LU 

LL 

a_Q-Q.ooo si- a: oo  »ir\oo  • 

LUC-« 

• 

^Q 

z 

v<OX 

N- 

»M 

i^MI 

_i 

X 

-»LU 

UJw-«w   •   •   .■«^ar*u- 

.-  JO 

X 

X 

-•ox 

a 

O      — ' 

LO 

M> 

c^i- 

-t 

1- 

— 1< — i 

1—  oooooOs-»rnl<"*CL</>  »u-^o*-      if 

h- 

— o 

o 

—»-»-»- 

^QQ-Z 

< 

<o 

<IOQCQoO^^^ 

||   II  (tV-,«-»t-<M— 

u_ 

^<z<.z 

O^ 

a 

o 

LU 

o^ 

o««sa.o.Q.ujuj  ii  Olu<oo 

LU 

mi 

Luaruj 

ox 

o 

1- 

ii  if  ii-^w*-,_»-ujMH-2:m-i 

\~ 

_I3TLUZ 

<r 

ujt-jfnirv'w'— •"•*  «l — 'i 

-4a:     — 

< 

<LU(—  LU 

_j 

l^^!i:u.u.u.uo<u.aoQM 

—I 

za;— i  a: 

x 

K—  O.  O.  a.  i— i  t-i  mi  Q.  CC  O  <—> '. 

3JLLOO 

Xi 

h3      X 

o 

o 

ooor>oo 

_i 

e- 

-j 

(\ 

1 

M|<CC< 

< 

<M 

UJ 

**      CM 

<o 

«-( 

1 

CCUJXUJ 

u 

OJj 

OO 

o    o 

UON 

cr> 

oomr"- 

OShS 

vO 

COl*~ 

»H 

lo    m 

LOt-l 

f-4 

r-<C40> 

IfV 

mm 

o 

o 

o 

oooo 

o 


82 


THEFIV    (con't) 


oooo 

C\J<\|OJ{\J. 
CNJrvjCJCM 

oooo 

UJLULUUJ 

IIII 
t— I— H- 1— 


ooooo 

ooooo 

LU  LULU  LULU 

inn 


oooo oooo ooooo ooooo 
oc?  cr>  o  B-i  eg  m  <f  in  oo  <7>  o  ^  M  m  «*■  in  -O  t»- 
co  ro  si-  <r  si-  st-sf  sr  stst-  in  in  m  m  in  in  in  m 

oooooooooooooooooo 

LU  LU  LU  UJ  UJ  UJ  UJ  UJ  LU  UJ IJJ  LU  UJ  UJ  LU  uj  LU  LU 

IIIIHHIIIIIIIIll 
t-H-|-l-t-^>-t-t-l-f-t-l-t-t-l->-t- 


OoOOOOOOOOOOo ooooo 
oo  o^  o  j-ks  ]  en  <j- m -0  r- co  <?•  o  «~i  o>J  m  **■  in 
in  m  o  o  *o  so  so  so  so  so  so  so  h»  r*-  r-  t~-  r- t*- 
o-j  cm  csi  wcvi  c^J  <vj  cmoj  a  (M  CM  <\i  cm  <m  cm  cm  cm 

oooooooooooooooooo 

UJ  LU  LU  UJ  UJ  UJ  LU  UJ  LU  U->  UJ  UJ  LU  UJ  UJ  LU  UJ  UJ 

IIIIIIIIIIlIIIIIII 


LU 


f-imm 


si-  — 

.-a  Q. 

<  X 

*  UJ 

i-i    05<;cl 
2-     _q.  — ~ 

^       IAmZh 
*£         "X    -3C 

a.    >a.z* 

O     (3  »  *  » 

u-     "->z(-Z 

1/5    »i— i    » 
IS) 


ULU.U. 


a 

LU 

or 
a. 


LU 


DQQ      -J 


<*:*  * 

LO  Hi  i— i  LU 

►IlH 

QOOq 

zqcqco 

i~<Q.Q.<r 

O-J-l-l 

-J-IJ 

JUUU 

<r 
o 


X 

a: 

o 

LL 

z 
a 
— i 

i- 
u 

a 

LU 

a. 

LU 

x 
h- 

LU 

< 
-I 

O 

-1 
< 

o 


is) 


a      . 


UJ       - 


x 


X        Ml 

**       — ■ 

*•*        X. 

17^: 
a.  *x 

— ~«ii 
t-  ii  — 

-JO^ 

r3i-i^ 

s:      •■ 

si- i-i 

-J      — 

JOQ- 

<ox 
o 


2^ 

O- 
II 


LU 

S- — 


3 
O 
■*. 

LUw 

£1- 

—»< 

l-O 

UJ      —  -J 

X      HJ- 

1-1        ^3   II 
I-  II  — 

LULL. 


O 
—  LU 
-5       > 

~>     a. 


CM 


l-iv^ 

-1  II 
II  — 


••ii  » 

li  "»••«  o     o  w^fnm    — 

—«        »UJ         •    •         •      O       OtH-"— — <MI— 

i-iCM^o    oo    o    o    o  ii  a.a.a-t>z 

oii£Zuja>t^  ••-i  »m  iO^xxx    3 

oo    —  >-0(\irnOtfi0^o«-«s<i  ii  ii  ii  oo 

roo^i-z  ii  ii  »  ii  ii  ii  ii  ii     ■ -q^: 

QO-Zi-i ~—— ——_«:*:  v,-;*: 

O  O*-«-*0\!.-ICM«-«CM«-aCMcj\:a:^*: 

o  »-«>-»  en  en  srsf  inmosHmin 

ouuoouuuooxxx 


ml- 

o<- 


i-ii 


oo 

rni-i 

rvii— i 

ii 

o-j 


II  Q-O 

^— *LU 
CMOI- 
LUi 

o>ec 

Qd.3 


<n 


5_,  (J\C00> 


0> 


CM 


o 


Z-5- 

Z)-5w  ► 

a  -^       >t 

<—a  •> 

— —-  m 

Q.O  — «—  o 
l-OX-  o— 
oeorn^jOCL 
_j  «^>J-  CM— 

_ILU<<—ct 
-Ih-SSLU 

<"-"a:oti-  _j 

(JOTOOhJ 
3LLU-QC<r 
30 


oooo 

l<lOo 


83 


THEFIV    (con't) 


ooooooooooo 
>o  r«- oo  o^  o  »-5<m  m  <t- tr\  ,o 

f>»  to_  J»-  f—  00  00  00  00  CD  CD  00 
OJ<\j<\l<\l<\JtM<sj<\J<\jC\4<\l 

ooooooooooo 

LLlLLlLLlLllUJUJUjUJujUJULI 

IIIIIIIUXl 
h-  h-  h-  H  (- 1-  K  t-  (-  (-  H- 


oooooooo 

Is-  00  CT>  O  ,-J  M  f">  «*• 
0000000^0^0^0^0^ 
<M<\|(\|CVI<\j  CM  CM  (VI 

oooooooo 

UU  HI  LU  UJ  UU  UJ  UJ  LU 

iinirii 

Ht-Ht-t-H-f-H- 


oo ooooooooooo 
in  vo  p-  oo  o>  o  t-)  (\j  ro  ^-  in  <o  r- 
o>o^o*o>o»  oooooooo 
c\j  (M  (M  <m  <\j  ro  co  <t-\  m  ri  i  ro  ro  ro 

oo ooooooooooo 

U'LUUJLUOJujUjUJUJI-Uujl_LiuJ 

iiiirniiini 

»^i —  I — »-^l —  I — i —  i —  t —  I — * — I —  • — 


<-« 

X 

— . 

> 

O 

o 

•"• 

«~ 

•* 

UJ 

-» 

to 

LU 

"» 

.* 

m 

LU 

o 

m 

LU 

X 

(O 

X 

<*~  •» 

X 

or 

— *     to 

X 

a: 

-^     to 

~» 

MM 

CMLU 

— - 

1—4 

t— 

C\|UJ 

>— 

p— I 

l- 

CMUJ 

to 

m 

OO 

%ss. 

_ 

1— 

►ST 

- 

1— 

-s: 

LU 

to 

> 

LUm 

UJ 

>— 1 

s 

UJto. l 

UJ 

>— t 

s 

UJ>-» 

S" 

LU 

s:i- 

T. 

to 

o 

XI- 

s: 

to 

o 

s:i- 

H^ 

— X 

> 

Tl|| 

I-* 

^4 

a: 

■—1-* 

-* 

ro 

cc 

>— ii— • 

1— 

(NJto* 

1-      * 

t- 

U. 

u_ 

1-      * 

i- 

u. 

u_ 

h-    - 

to«- 

i-iX 

UL 

<—>• 

u. 

I— itvl 

tO 

LUto* 

u 

to= 

OO 

H^ 

z 

—  »T3 

00 

to* 

2 

—    to!3 

> 

— -S"   « 

H. 1 

zt 

> 

o 

o 

t-JCOCt 

> 

o 

o 

*-4inc£ 

to-3l-l> 

X 

X 

to* 

-x»- 

X 

to* 

•xh 

X 

•t-3 

a. 

•*      *• 

1- 

to 

(- 

<M   to  •• 

h- 

to 

1— 

W  »  to 

1— 

(Mto*C£ 

< 

»-»- 

H* 

1- 

< 

1-»- 

i.^ 

1— 

< 

•+-f- 

Q. 

-  *»- 

cc 

ZZ 

oo 

z 

to* 

inzz 

oo 

z 

H-* 

hZZ 

LU 

inro  •■ 

o 

35 

o 

3 

> 

uXO 

G 

x> 

> 

U33 

a 

oxx 

o 

Oo 

Q. 

o 

UJ 

toOO 

Q. 

o 

UJ 

•OO 

-  »3 

LU 

** 

X 

^ 

o 

CO;^S£ 

>• 

i*: 

o 

m^:^ 

tvj 

>*-to^o: 

O 

<t<r- 

•*•  » 

-<- 

~-  • 

-u<t<- 

—»  . 

■»«*- 

«*v    **• 

■u<<- 

-.-  . 

-UXI — 

to.  ^» 

»*w^(  wo—'in  «Ow~ -wN  •o«"'vo  •O'"'*—  ~»cn  ^o«—«'~-»^  *o 

Q.Q.OXOO.OXOCLQ.Q.OXOO.OXOQ.Q.O.OXOQ.Q.CLOXO 

I—  t—  oour\o»i—  oomo>f—f—  H-como>f—  oomo^H-  t—  t—  oomo>i—  i—  H-comcr* 

OO 

►CM 

►a 

to<M 

toOOO 

-CM 

-a 

•cm  »ooo 

toCM 

•ooo 

•04   * 

_J_jvO— >0— 1«0«-*  vO_J_J  — JvO»—  ^_l<0— '«0_l_J_J>0— vO_l_l— ivO— -*o 

U-CL- 

-h-> 

»Q-» 

-»-« 

-.a.  a- a.. 

-I-- 

-U-- 

-1— - 

.Q.Q.U., 

»l 

_ClU.q., 

-4-«- ■ 

UJ<tLU      LU^UJ                 UJ^LU       LU«iUJ                 LU*tUJ                 LU"^UJ 

-J -IK 

-SI l-J-JI-ZH-lt-STl UJI-SH— l-l- U-STI- 

_J  -J  ►««  0C  HI  _J  _  C£  to*  _|  _»  -J  h 

-  or  i-i  _j  »-i  oc  *-•  — i —J -J  ►-*  or  ► 

— • 1 1  — Ii-iQCi-iO 

<i<ccocf  <o;oo:<«o:Do:«roa«<cioa«<o:aa:z 

Uu2u.2U2U.2UUU3UiZU2u.2UUU2U.2uUU3U.2UJ 

•M 

m 

o 

C\J 

o 

m 

>d- 

O 

oo 

o 

00 

o 

O 

OQ 

oo 

00 

oo 

84 


APPENDIX  C 

TRADITIONAL  EXTENDED  KALMAN  FILTER 

THESIS 


oooooooooooooooooooooooo 
j-^rvifo-tf-if^vO^  oou,0»-3CMr>M'in,Of'wootT  o^itMcri^ 

QOOOOOOOQ^W^i-1p1hHHHH(MNNN(M 

oooooooooooooooooooooooo 
oooooooooooooooooooooooo 

IXIUjmmLLJLULULL'LUUJUjmaUJLUU'LUUJUjLUUJUJUJLL) 

iiiiiiiiiiiiriiiiiiiim 

>-l-t-HH-l-K(-l-h-(-l-»-t-t-(-t-t-H-t-»-(-t-l- 


ooooooooo 

ooo 

ooo 

ooooo 

i^-  OC  ct>  O  «-i  C\l  (>">  <Mf\ 

r-occr 

r-irMro 

trvvOf   oca- 

(M  cnj  (v  m  m  r«->  m  ro  ro 

mrnf^ 

^^sf 

Nj-Nt-t-4-Vf 

OOOOOOOOO 

ooo 

ooo 

ooooo 

ooooooooo 

ooo 

ooo 

ooooo 

LUU    LU  LULU  LULU  LULU 

LULUUJ 

LUujLU 

lululululu 

IIIIIIIII 

XIX 

xxx 

xxxxx 

Kt-t-t-t-l-f-t-t- 

(->-*- 

K(-t- 

1 — « —  1 — t — t — 

•o 
mm 


to 
o 


tnm 
—x 


»    <* 


xo— >in      •»    |— • 
a.»-*cn  *    **•     i>4 

•in  **n    «•  »  •• 

— — ro  •»  HM*" ■— •  » 
tn^i— o— s:  tn<j-»- 

►X3»-4(\JLU    ..—CM 

to  »->if>— (—  inof-i 

_— o— cmow,vJ  •> 

^coo^oocm  »»o 

»-ii  *  »a.  *  ■or— — 

LAQ-tr\—    •—-— .UJnJ-O 

— h-. — ip—  oiiai cc: 

^£xa  »o—  «»Q-s:o 

x  -ai^ino—  »-x 

**— i—  o~  ►^in —  •< 

—•$*<-*  "0— 3:  •■«*— 

in  ••  •— uj  fouj  in— o 

in — o  •q.qoh  »m 

— accsjco  ►hos->w 
v^  ► — — «—  ••  piurtm 

*:— <ri-o«— !-  -ll 
o.m<  <^jOin  a  i^-u. 

»  ►  ►•y  ir\t>^«—  •o1- • 
— in—y— inrs—-  »o 
in — *•<!-- ctn—x 

•><    »<J3ZMa- <m   - 

insrin  oOim 

WX--OQ:  *Ovoo 

^)<l_  -$■>£(—- —  «•(_>='-* 

srtax-—  <  *<m—  «^n 

^  «.  •■«  ••. 1— — 

^— — ivj-~Oin«- »4rn 
Q.inin  ,.ohou.»u.» 
••  •  •—  -sin  ►uutu_<j- 
— m^i"^tn— — "-t^1-1- 
in——  ..— >cjo  *Ooa 

»-»x  »-za*  *<m  «•  •• 
s  a. — oxih-o— w— — 
^    in  ».o  •>  •^coo«*' 

xoinvf  «oo>f  "indi 

2:toa.^ominsms-^  » 

OZS-  =-s—  -CD   fLU— 

stluujs:  mXinzmiL-t 
?zh  x>— x>— lu— ,-4— m 
□i-i^zmoiQ.O'-'acD  ii 

ooaoxi-xoujxxz 


to 

LU 

to 

a 

CL 

to 

O 

— . 

z 

O 

CM 

<r 

o 

r-1 

cy 

H* 

•» 

i— 

CO 

=-a 

• 

II 

H- 

> 

• 

-5 

LU 

H-# 

o 

•k 

a 

G 

oo 

—. 

N- * 

i 

O 

°H 

—) 

LU 

*^ 

to 

.■.«— 

H-0 

«^ 

•t 

~ 

LU 

XX 

co 

tr 

»-H 

X 

— ' 

» 

o 

— —   •■   «. 

•• 

in 

•_> 

»— » 

z 

z 

t— ) 

ZLOXZ 

o 

«=» 

a 

(X 

■z 

•» 

•■ 

a. 

•"-5    ••    •■ 

LU 

O 

•4- 

a 

\- 

•k 

«-« 

orf 

H- 

Z   *3< 

X 

< 

>H 

o— 

< 

t-S 

3T 

X 

< 

-oo>S 

>-4 

o< 

—  • 

>--rf 

X 

II 

i^ 

*; 

•z. 

-"-502T 

K- 

H-tOJCO 

X   • 

-J 

*: 

^: 

x  -o< 

-5 

to 

•  ♦•"O— >o 

>- 

^        z 

X 

a. 

t- 

CLtf-O 

— . 

_ 

4-0 

» — u. 

1— 

•oo  •■ 

o 

— * 

-^ 

Z 

— »"-»     — 

o 

— -J 

J-0«-JCT«c\l 

l-H 

l-»^  ••-< 

• 

o 

o 

< 

QQOQ 

o 

momu  ii  m^ 

h- 

II  s>jO  II 

1-i 

< 

< 

1— 

<«<I 

CM 

"-•CSJ, 

— l-lMr^w 

Z 

H*         II  hH 

II 

*^ 

LU 

^» 

LU 

to 

LULU  LULU 

I.- J      » 

—  ► 

— <s> 

•t— 

LU 

o— 

— . 

g>9 

Cf 

.-1 

CC 

z 

CCcCCCa; 

mint—  m<  it  or^< 

Q 

oa-3«-' 

I—* 

1 

5» 

1 

z 

o 

2ISX 

•«^> 

<— 

ruo»wZ 

>-H 

"4-       *«*■ 

•» 

^ 

^ 

o 

^rlQSQoiOSQQC 

fi       >-'v4 

1— 1 

o 

_l 

O 

_J 

1 J — ) 1 

mu  ii  ii  <oc<n<J 

<n 

Z 

w> 

M» 

*— 

_l 

«^ 

-J 

z 

— i 1 — 1  — 1 

II  OOOOOLUOUJU.^OLULU 

<l 

O      "-"O 

1— ( 

X 

< 

Q. 

< 

t-H 

<r«a.<< 

Z-3»-ih-ixU.0C 

looo: 

Q      LUOlu 

o 

o 

o<->oo 

X 

o 

c 

a 

ih 

at 

< 

< 

«i 

o 

o 

CT>tT> 

o 

o 

1 

a 

o 

LU 

O 

!\J 

o»m 

LU 

N*- 

<t 

-j 

_l 

QC 

cm 

|»-(W, 

1^ 

e-4 

OOO 

o 

o 

O 

85 


THESIS     (con't) 


oooooooo 

Lnm«or»-f-  r-i*-^- 
oooooooo 
oooooooo 

UJ  LU  LU  LU  LLI  uj  LU  LU 

IIIIIHi 
t-t-H-h-l-l-t-l- 


oooooooooooo  ooooooooooooooooooooo  ooooo 

r-oo0^o»-ii'Jr«'>-4-iAyOp'00  c>Oip^c^pi*fLC'<)f>~cou.o»-](\ist-crOi-«r\<rosj  vot^-ooo^o 

r-|^r--0C0000aDaD0000CO00  O^OOOOOOOOOQ^iH^iHHfvKVJcgWN  (\JCM<\jC\JcO 

OoOOOOOOOoOO  ZDw*>rt"**-i*lt-l*«^~<r<*4i-<^ii**^*4i-ilr*~<i-l  ri~i~,r:^ 

OOOOOOOOOoOO  OOOOOOOOOOOOOOOOOOOOO  ooooo 

UjILIUJUJLUUjLUUJluUJlliui  UJ^UJUJLUUJ^LUuJUlUJUjLlJUJLiJUJUJLU^LUUJ  LULULULULU 

iiiiinrini  iiiiriirniiiiiiiiiii  inn 

- 1 —  l —  I —  I —  I —  t — * —  i —  I —  t — 1 —  I    t 


m 

i— i 

to 
X 

CM 


LU 

■ST 


o 

< 

-1 

oo 

o 

■z 

HI 

to-l 

•E 

*. 

►— 1 

O 

►^ 

t- 

< 

X 
a. 

X 

Y- 

— 

o 

X 

*« 

<r 

00 

—4 

•4- 

LU 

1- 
o£ 

o; 

>— « 

X 

< 

< 

ivl 

_ 

— 

(J 

i— 

s: 

+ 

CD 

h- 

•D 

o 

00 

— 

rvj 

< 

O 

T*i 

— 

2T 

ro 

to 

s: 

at 

■o 

to 

a 

w 

CO 

s— 

X 

CM 

i— i 

*^ 

>■ 

<■- 

f- 

—    o 

i-^ 

t- 

rM 

to 

o_ 

C*4*-*       1— 

to 

+ 

CD 

*x 

LU 

1   1  — 

X 

oo 

-— 

X 

ta 

i- 

(""icOroO 

Ol 

•z. 

CM 

m 

►  «• 

< 

l— II— (•— IO 

to 

^ 

< 

to*          *to 

^«i 

3 

zz 

a: 

LU 

#**  — 

to 

O0 

or 

'—    ,-J 

X 

X 

o 

•*  to 

LU 

s 

mmm3: 

i£>- 

-5 

i- 

rsj     I rviCM 

to 

t— t 

CL 

<--r 

i— 

1— 1 

to     „     toOO 

i«i<r 

to 

+  f\l  1  CM   ••  «. 

O"—— — « 

at 

X      — 

-E  ». 

>-* 

1 — 

j-ooajoo  • 

toQf 

H* 

LU 

—  1—  (M    to^lf-4 

H-^HMro 

l- 

to       -5 

Z-i 

1— 1 

•.'—••—•'—•l — 

oo  et. 

rvl 

1— 

to-l  II  l-to- i-— — 

to»^    —*<... ii 

< 

00>       *» 

<x 

o 

J-1 

►H— — "O 

>-i<r 

•^ 

< 

*■*  s»^*^  *"^  l—l  to- 1 

OQQO 

£ 

-5^:    3 

OQ- 

t- 

+ 

•H 

II  aoo  • 

^•» 

O 

1- 

WI-+HII 

— » 

<l-l->- 

►—ZO 

w— 

LU 

•  ii  rootaro-:-. 

<J>     to     •     , 

< 

00 

rM—OXQ-Q. 

CM 

LU  II    II    II 

X 

»-im     toQi 

fcOOO 

a. 

X 

o^:1 

*iOOO»-3 

mxoo 

LU 

~_jl-0-  II    II 

•» 

CC—  — -— t-l 

II  SHI 

zz 

o 

»-* 

•o^ 

»>w 

to-»-100 

ae 

LU 

*     •  II    II  - 

s-9 

OTiii^i^O 

LU 

>o  "I  II 

<<r 

o 

t-OO      ' 

OIIIH 

-oo 

a 

X 

—  O— — -^jfO 

^■* 

i— ^^is:o 

X 

^a:"'— 

en  or 

_i 

10CiO>0  H    II    'I  """'s-'-OI—  vO<3 

V- 

LAUJCM..+.   ••  „ 

^^ 

*^'^-»»»0 

1- 

X      > 

t-K- 

II  I 

O  1  0»«0— — *—  ii 

+  —<  1  1 

—i 

CSJ    •    •.  ^f\|»* 

X 

_jX>rslO 

OUHi 

LU 

LUvO"— 

rOrOroi^t 

I3LU3:3I— 

—i 

> 

•  :^»-'m—' — cmo_ 

_|-3"3r3    • 

LU 

f\4      C\J    •* 

_l_l 

X 

rmxo1 

~>t-  orooX 

< 

CC 

~-*:. i-t-i-  it 

<a:oicc  ii 

1- 

i-1_Ji-S~? 

-J— 1 

1- 

toH 

II    II  QO-w-w 

II  MQ    II    II 

i_j 

< 

ii  >r 

O*— "-•■— oo 

< 

-X      <— 

<< 

HI 

H--S 

CD  QD  IB  LL  00  CC  LU  3 1— 

> 

CIU.XXIIHH 

a. 

—1 

o<oi- 

ou 

h- 

nh; 

XV) 

X>rvli-il-l3       OOX 

1—  "-lO-Q-O-O-l—  <t 

LU 

o 

COOI 

o: 

LU 

o 

<a 

z 

-J 

l- 

O 

<J> 

o 

f— 4 

< 

oo 

o 

m 

^i 

h- 

o 

OOo 

O 

r- 

-O 

OOOu 

oUuo 

oo 

o 

86 


THESIS     (con't) 


oooooooooooooooooooo 
in  o  r-  od  <x-  *o  t*-  oo  o-  o  i-<i  -4-  m  o  |*»  oo  o  r>-  «o  o» 


oooooooo 
oocr>  co-4"m>Orti<j- 


rnt^rr>rnfi-4->i*>l">l"ifMr\iriir\mmir><oo<nr>     r-r*-cocoooooo,cjv 


oooooooooooooooooooo  oooooooo 

IXILULULUujUJUJLUlULUujU-'UJUJUJLIJLIJUJLULU  uj  LU  LU  LLJ  LU  UJ  LU  LU 

HiiiiiiiiiiriiiHii  nniiir 

I —  I — « —  • — * — • — I —  I — • — I —  i — I — » — I —  I —  I — I — I — I — I —  KHt-hl-H-H-l- 


oooooo 
f—  aoa*o,-i<M 

O^CM^OOo 
<-aH.-5f\JCMfVJ 

oooooo 

LU  U  I  LU  L_J  LU  LU 
IIIIII 
l-(-Kt-t-l- 


oooooo 

oooooo 
cuca^-T^CMCM 

OOOOOO 
LULU  LULU  LULU 

nun 


CC 

n 


CC 

^rOir\ 

QC 

^^^: 

LU 

Q.Q.0- 

^m 

II    II    II 

CM 

z 

CLQ.Q. 

z 

a 

—••—•"-• 

~-UJ 

MM* 

>-* 

— •+ 

#W»ll^M— 

— t^t— — 

o 

i— 

*L 

irvinm 

SXQX 

ft 

< 

iC 

1- 

i:^:^: 

DUJ'JO 

00 

Z 

—.«—  0L 

Z 

«■ 

0-O.Q. 

Zt-  -2 

~5 

»— ■ 

OCM   ft 

UJ 

CD 

•    •    • 

(JQWUJ 

ft 

1- 

*^ 

-53TZ 

s: 

r«j 

LULULU 

•O-jQ 

O0 

oo 

o-« 

ftUJ    ft 

UJ 

ft 

OOO 

00   ••  ftO 

—) 

UJ 

X 

Ol-Z 

cc 

CO 

•    •    • 

iZZ  .. 

*» 

ft 

UJ 

i— iQ-    ft 

D 

> 

f-jmin 

ft  •>   ftCO 

—a: 

-*— ■ z 

Ii. 

t- 

w  ftZ 

00 

•t 

^^^ 

ZZWT 

<LU 

H4M      ft 

a 

Q. 

HZ    - 

< 

co 

O.O.O. 

X 

►  •— 3    * 

»-«l-4 

hmi   t«g 

ft 

S   ftft* 

UJ 

X 

K 

'«.!  ».  «—' 

H^ 

Zoo  ftCO 

ft     ► 

— w O 

UJ 

z 

UJZ5" 

s. 

ft 

< 

•  •  • 

a: 

»-5»--5 

<oo 

<<Z 

o 

ft 

H-   ftii 

1— 

X 

ooo 

»- 

(—  *x  ► 

-5CL 

«3<LU 

z 

OO 

a.^)^: 

UJ_I 

< 

P»4 

■z-z-z 

< 

X-*   -OC 

wLU 

II    1"  O 

< 

-5 

#ro. 

x< 

X 

1 

— •*•  <t<< 

z 

►Si-»  «. 

< 

z  * 

< 

— —o 

>— 4 

pi 

Z    «LU    ft 

K-O 

M 

» 

—  .  •  • 

tm 

h^sm 

H^ 

COO 

t— * 

<<   ► 

CC 

Z 

ft^lt— CI 

o 

ft 

CO 

•-devim— »-"■•— 

—) 

2 

Z^LUaT 

ft 

2-5 

ft 

•-•-»z 

■< 

•t 

^  1  CLS 

U__ 

ooco 

1— • 

ft    ft    ft<<l5-4.-d 

•** 

ft* 

^a.|_uj 

O0c_J 

UJ    ft 

COs-J 

»  «o 

> 

xz 

II    II    ftCU 

O^o 

-)>-. 

*^ 

^mmiii«;^: 

3 

< 

ac  ►oi- 

-3  II  »-«0< 

-j  II  t-a.«z 

a 

ft  ,^-}^_l_ 

UJ 

ft^ 

H-4 

^-— '^»Q_CLQ- 

a 

o 

Q-xoo 

„<  +  0< 

»<  +  ~3.-iO 

o 

u^iaujo. 

ujq: 

c-jfO^rvl 

^i^^i  •  •  • 

cc 

—w—  O 

.-»->.- 

«  II  «- 

,^->_ w 

— >  ii 

y 

H- 

it  i-<  ii 

^i^^UjUJUJ 

X 

UJ 

QQQ- 

II        >-t— > 

II       hSJQ 

LU 

QQN   •     O 

^UJ 

co<rX-~ 

CLQ-O-oOO 

II  UJ 

X 

oooo 

<CO  II 

IHZ 

<<4" 

llOQO 

X 

a<-> 

NDQO 

zx 

mINcD 

LLJ'-"^**    •    •    • 

—  O 

h- 

oc;a:a:Q 

M(VH"»H 

woimZZiv 

t— 

cc 

(-)MQa: 

>-ll- 

rvl  II  i— i 

i-  ooo0o",e-»rotrv 

->-z 

a.O_o_< 

ww(/) 

"-•uJuja 

a.f- 

*-<Q- 

H- 

r\io- 

ft»ft« 

<cccoco^:^ii^ 

ft»  < 

LU 

mo 

< 

J-O 

QC 

UJ 

<M 

OH 

OOUJ 

(M       COLL 

0<<<CL.Q-Q. 

>»- 

t- 

-IJJJOWO 

<JOnQ 

OOJ 

1— 

jHQrJ-i 

LUI- 

H-l  —  U. 

||     II     II  w->— 

*Z 

< 

_l_J_j-J  II 

-J  II 

—1 

< 

_i 

LU-J-J 

< 

_l- 

^•— I 

UJ  *<  CO  ITl  ft»i  »-•  <» 

— o 

—1 

<I<1<<Ii-iO 

<.-.o 

< 

_l 

<o 

|-<t< 

-Z-i 

0<IQ 

X^^^U-U-u_ 

IU 

3 

UoUUhQ 

UmO 

o 

Z> 

oo 

Q.OO 

<o 

QOrxirsj 

|—  Q.  Q.  Q.  ■—«>-»  i—i 

O 

o 

o 

-J 

-J 

l-_l 

1- 

^o 

< 

•<l 

I*- 

UJ< 

^J 

LU 

CMfM 

o 

en 

<J- 

o 

CM 

'JO 

og 

00 

»)t-4 

CM 

CM 

«^ 

^j 

o 

<_><-)<*H_ll^i_3<~><-HS<J><->{_) 

o 

ooo 

<~ifj> 

87 


THESIS     (con't) 


oooooooooooooo 

CM  CM  CM  CM  CM  CM  CMC.)  <\|  CM  CM  CM  CM  CM 

oooooooooooooo 

UU  UJ  UJ  LU  LU  LU  uj  UJ  uj  U I UJ  LU  UJ  LU 

IIIIIIUlIIIII 

h-H-l- 1 — ) — I —  H+-H- 1-  l-t-h  H- 


oooooooooo 

mxor-<r>cr-Of-jrr\sl"f\j 
c\(  cm  c- j  c\j  cvj  en  rn  ro  m  o 

CM  CM  CM  Cvl  CM  CM  CM  CM  CM  CM 

oooooooooo 

UJ  UJ  uj  UJ  LU  UJ  UJ  UJ  LU  UJ 

IIIHIIIII 
f-  (-  (-♦-  H-  t-t-»- 1-  »- 


ooooo 

>$-«-*  CM  CO  ,d> 

MCMCMCMcm 

OOOOO 

LU  UJ  UJ  LU  UJ 
Hill 


OOOOO 

-or-ooovo 
r^-r^r-i— oo 

CM  CM  CM  CM  CM 

ooooo 

LULUUJUJUJ 

niii 

Kl-f-l-l- 


OOO 
t-iCMO"l 

co  oo  oo 

O.JCMCM 

000 

LULUuj 

XXX 


ooo 

Of-  00 

cccooo 

CvlcsjCU 

ooo 

UJLULU 

in 


OOOOO 

00^-)f\|fTl 

ooo^ao  o^ 

t%J(\jCM<\|CM 

ooooo 

UJUJUJLUUJ 

niir 
t — I — I —  I —  I — 


*>J 


UJ 


ct 

< 
> 

UJ 


co 

□ 

UJ 

o 

UJ 
UJ 

o 

X 

— .  LU 


o 
o 
in 


— o 

LUI- 

t- 

<o 
oo 

+  LU 
— UJI- 


■z. 

UJ 
UJ 
03 

< 

X 

o<o*: 
-Jo  »s«:uj 


oo 


o 

»Ow 

II  00— ' 

O«^oo 

_jv.aj 

o.< 

O  II   II 

OUJUJ 

inj-i— 

ooo 

OO-OC 


i lO<I 

o 

oc— -»- 

CJO»(  * 
CO—IO- 

— "— ino 

•  li.-Ow 

II  OUJ< 
UJNJt— 3" 
I— ' -»-<OC 

<u-oco 

OH3U. 


'  II 

H-JO 
II  • 

X     O 
-JCM  II  CO 

O— • OLU 

in^-mx 

CM       _l       Z 

OO   HZS>— • 

_l    z 
a    -co 

Q      OOo 


UJ 


00 

UJ 


UJ 

X 


UJ 


-5      OiiC*^ 

z     —  XXX 

»      isl  |     |     | 

+  **cQ 

~x>xx 
Zs-sacacoc 

►s:  i — i — *— 
^t^.  n  ii  ti 

n  *:— — »~ 

i-l  ii  ^c^:*: 


x 


LL 
U. 
t— * 
Q 

O 


>*-o.-icnm 

rviMU.u.u. 

^«— U.U.U. 
QXXXX 


tri       0_ 

<     s: 

►       LU 
0~|- 

o-aO^a. 

5>- Id.     .s— 
^iOO  MZrf 

^  -x  -x 

i— •  *  -^ 

0CO2ZQ.  oi 

OO  «  ►  ►  O 

U-«2hZ  LL 

oo  ••'-«  » 
oo  'ZI7     oo 
?o  "O-  •■     Z 

oo^  »a  o 

•-•■<^^  •»  « 

i-  ocls^o-  h- 

o-4  ►a.s: 

wV)i-"i-iUJ 

o  -XXI- 

UJi^Q.O.^ 

Q.-QQ- 
OOOQ 

luzococo 

IwQ.Q.< 
l-U- 

o_j-i_j 
UJ     r — J t 

<Juoo 


5" 
X 


^     o        ^ 

X      m  Q_ 

••      —  II 


O 

o 


v 1  CM       O       <      «>  •*■ 

O  O      O      <_)      o  CM 

in       m    mo        in  »-• 

OOo 


X>o 

o 

-i 
< 
o 


o    *-•    *:    z~ 
■-I     X2T*:       --> 

a.  ►xz^-j-j 

>—t-«  ii   •>  ii  » 

I—  II  -H")N  • 

-JOliC  II  -J1-*  O 

Xn-t^M       "UJ  •  •        •     O 

ST        •■•-•oT'Ki^j  OO      O      O 

X.-JO    m^^ujo^s^  •,-«  »m  • 

<t-~>ta    —iiDwmOino^o 

-I      — roO^l-2  ||   II    ii   II   II   li   II 

-jQa  qo.Zm«— „-» 
<OXO  Oi-^cjs-Kvi^rj^ 
O  O  U2- ' — 

o  — j^-]  *n  ci  .4-  <r  lo 

oooo<->ooo 


o 

LU 

oc 

CL 
LU 

X 


LU 


O 

o 

< 
o 


00 


O^COO* 

cnocy 


88 


THESIS    (con't) 


OOOOOOOOOOOOOOOOOOO0OOOOOOOOOO0OOOO0OOOOOOOOOOOO 
O*  0s  CT>  CT>  <J»  CT>  O  O  O  O  O  O  O  O  O  O  r-l^w)  s-)t-J  t-4_i  lH  *-5^  CM  CM  CM  CM  CM  CM  CM  CM  CM  I M  CO  CO  <t"|  m  CO  CO  CO  CO  mCONj-<f 

cm  cm  cm  cm  cm  cm  en  cocococoo  ico  en  co  cocorocom  co  cococo  coco  coco  rococococococoromfococococococorricocnco 

oooooooooooooooooooqoooooooooooooooooooooooooooo 

LU  LU  LLI LU  UJ  LLJ  LU  LU  LU  UJ  LL  LU  UJ  LU  LU  uj  LU  LU  LU  UJ  LU  UJ  UJ  LU LU LU  uj  UJ  uj  LLi  LU  LU  LUluUJLUlULULULULULUujLUluLULUlU 

niiiiiiiiiiiiiiiiiiiiiiixiiiiiixiiiiiiriiiiini 
i — i — » — i — i — • — i — i — i — i — i — i — t — t — i — »—  i — i — ) — i — i — » — i — i — t — i — » — i —  i — i — t — i — t— t — t — i — i — t — t — i — i — 


CjO 


LU 

— » 

•» 

— 

X 

— 

> 

i— i 

o 

- 

o 

a 

w 

«• 

•a. 

— 

•» 

LU 

•» 

m 

LU 

— 

H 

LU 

m 

m 

LU 

O 

m 

LU 

3 

rn 

z 

ST 

•» 

— «•  •» 

s: 

a: 

*■»       •• 

X 

OS 

^^  » 

MM 

"^ 

Z> 

>— t 

t-4 

CMUJ 

•• 

M 

t— 

CMLU 

— 

■—I 

1— 

CMLU 

. 

CO 

o 

1— 

>—♦ 

►ST 

- 

h- 

►5T 

V 

1— 

►3T 

LU 

•» 

*£ 

H* 

•» 

LUh-i 

LU 

^— • 

s: 

LU*- 

LU 

^— t 

3T 

LU>— i 

3: 

LU 

aiw 

•• 

_ 

5TI- 

3T 

•» 

o 

3Th- 

5T 

•k 

O 

s:t- 

•--« 

—s: 

3TI- 

o 

•» 

i  «•»« 

MM 

V* 

oc: 

>-m>— • 

»-m 

en 

a: 

i— <"* 

K- 

CMi-i 

l-l< 

— 

LU 

■ 

1-   •* 

H- 

U. 

a. 

1-   •• 

H 

u_ 

LL 

i-  - 

»t- 

f-O 

-5 

> 

•» 

"-•X 

u_ 

H-l> 

LL 

— ivj 

ol 

LUh-i 

LU 

— t_J 

-5 

Q. 

j-4 

LO 

1— 1 

^ 

—      »Z> 

LO 

►^ 

2" 

—  -■d 

> 

—s  ► 

ST 

•LL 

•• 

•» 

H4 

t-li-ICJC 

> 

Q 

a 

^coct: 

> 

Q 

o 

«-)LOct 

t-i>-<>- 

H-« 

e-4  ■■ 

UjN 

1- 

■» 

•XI- 

X 

HM 

•Xh 

X 

t-M 

.XH 

X 

H-O 

h- 

II  — 

S-t 

z-i- 

CM  m  * 

K 

*• 

K 

CM   ••  •• 

H 

*> 

f- 

(N    f   » 

(- 

cm  •-•a: 

(■» 

viLLLU 

I-*   * 

O-}— 

H-H 

H»l 

1- 

<T 

•+-I— 

■— • 

h- 

< 

•+-I- 

0. 

"  •+- 

LU                  mhmm 

l-S»£ 

O 

►^ 

-tzz 

I/? 

z 

*-H 

LT>2TZ 

00 

2 

1— 1 

•HZZ 

LU 

men  •• 

S ^i 

II        •— 

M^ 

*.^*C 

OOO 

o 

o 

> 

oon 

O 

3 

> 

OZDO 

Q 

uxx 

M^^^   II 

-mh 

••M** 

-.<■-.  Q. 

►Oo 

0. 

o 

LU 

»qO 

a. 

O 

LU 

•Oo 

»  *o 

t- :*::»£:*:*:  ^,^22 

■-)^0~- 

— — 

m^^ 

X 

^ 

Q 

ro^it: 

> 

^ 

Q 

m^i^i 

ixl 

^-»-«oc 

•  >— •     ••    •>    «— 4 

<-ls^_>    »• 

ii  o-oao  •— - 

— •o<r<- 

^»    # 

-<l<- 

*•     * 

-o<<- 

»—  « 

-<- 

"•»  - 

-o«- 

>_  -■ 

'OXh 

o  »-^icom 

w    o«-« 

:*£  II  0<|-OX- 

3«~w,_g  •O^m  •o**~"^cm  «.o—-o  ►O'— ••»— ro  *o»»"»'— 

Oi-*— —wCMI—  O^J  II 

ae-» 

'OflOCOHOao.aoxoaoxoQ-a^oxoaoxoo.aaoxoo.Q.a. 

O  II  0.d.Q-OizQ<|M 

2»iO_l 

•CM-  i 

(T>  I—  i—  I—  co  in  0>  i—  oo  in  <jn  j—  i— 1_-  oo  vc\  o*  r-  oo  in  o*  i— »—  i—  oo  ifi  o  i—  h- 1— 

Oi^XxX 

r>       <-• 

02«i« 

_0-  vO-'— • 

»aoo 

»CM 

•o 

»CM 

J3qO 

•<M 

•o 

•KM 

•oac 

►<m  »aoo 

p^  ii  ii  n  no 

sJ-~LU      . 

v  h- 1—  ^O  _l  — 1  _J  -O  •*  »0  _l  vO  w  vO  —J  _1  — 1  -O  «■»  -O  _J  ^O  — '  >0  _ 1  — J  _J  O  »■>  ■£>  — 1  _l  — J 

it     — — •— ax:        oo 

CMOI— _JLU« 

wQ-o-a., 

-l-» 

^Qu_)_« 

.Q.CLQ.. 

'I-- 

-a~K 

^U-CLQ.^ 

-»-- 

,a.o.u. 

— ~**i£>£ 

(T|ivj      LUt-t—H-XSTLU                 LU<LU       LU<LU                 UJ<LU       LU<UJ                 LU<TLU 

cmon^C:*:^ 

tV<—a>CC<> 

-ta:a:j-_u-i>-Si-_ij-5-i — i_j-^ 

-si--it-zi — i-J_iv-s:i--J_i-J 

—■          _■  ■  .    -!.r 

II  QClSOOCOO. 

Ml  _J  _J  _J  ►-•  QC  1— 1  »J  1— 1  Ql  1- 

-_)_j_ iwttM i~ •a:'— >— l_J_i>-.er"'-<-J-j— ) 

ma^Hcom 

0-3 

3LLLLot<^<ia:Oa:<c«:occ<<«3.a:occ<ctaa:<r<r<r(Xc'Cic<<t<3. 

OQXXX 

Q-J 

3UU03U.303U.3UUU3U.303U.3UOU21L3OOU 

co 

o 

i 

DOO 

»9 

LO 

o 

CM 

o 

ro 

«-1 

CM       r-) 

•t 

t 

■noo 

o 

00 

O 

CO 

o 

a> 

a»     »"• 

CM 

i 

NJCOO* 

oo 

co 

ao 

89 


thesis    (con't) 


oooo 
oooo 

OJUJLUUJ 
XXXI 


> 


X 
Q. 

< 

o 
o 

LU 

o 

•4-  »o 

oxo 
oomo* 

•<M  •> 

-h- 

UJ<LU 

hSh 

i-iQCi-iO 

OlOCCZ 

2U.2UJ 


•4- 

o 
oo 


90 


APPENDIX   D    -    UTILITY    SUBROUTINES 
SUBROUTINE    AUX 

oooooooooooooOoooooqoooooooooooooooooooooooooooo 
oooooooooooooooooooooooooooooooooooooooooooooooo 

OOOOOOOOO0O0OOOOOOOOOOOOO0O0OOOOOOOOOOOOO0O0OOOO 

xxxxxxxxxx^xxxxxxxxxxxxxxx^xxxxxxxxxxxxxxxxxxxxx 

<«<<<<<<<<<<<<<  <<<<<<<<  <<<<<<<<r<<i<<  <<<<<<<<<<<< 


••   •• 

^ 

O— 

0 

z— 

^^ 

•■<_> 

•i 

-_l 

CD 

z  « 

z 

z  » 

•ft 

•.—» 

— . 

•• 

*5T 

_ 

coz 

~) 

CD 

CO— 

^ 

^ 

«M-» 

-co 

•» 

<tOD 

CQ 

<z 

<   » 

H^ 

**•   •* 

* 

— — 

^■*»«. 

««* 

1 

«-» 

H-CD 

QZ 

< 

-IZ 

"J 

_J    •■ 

O  ► 

+ 

3     » 

«k 

— >«-» 

OCZ 

-— • 

2T2T 

»— 1 

srz 

*■« 

O-  — 

"J 

£-" 

«■» 

>-' 

•— » 

<r 

•» 

< 

< 

< 

— 

uj    z_j 

2_is:>-« 

IU      Z 

z  + 

UJ 

ZCD 

zz  -  ► 

•    *  *   »■— 

zz  ► 

W~— 

ZZ 

►* 

mO>  iiiio«-i«-<«-a<_; 

mOh 

H^OI 

**o 

IF^  — 

«-•-•  II  II 

II  II  II  II  II 

1—  II 

.11— ^ 

1— — 1 

II     -1 

3t/T-«-V 

-..-.-5*:— 2 

Doo>~r 

cnuzz 

3</> 

>-■— Z 

OZ 

-)            -so: 

oz 

II       II  **cc 

oz 

•doc 

c£LlJ_liH 

«<M<M<\J   *rj 

oCoirO' 

-^-.f-ZJ 

aruj 

••o  +  :3 

II 

—i 

zr 

►Z 

-5 

w» 

^^ 

CO  — 

•» 

— 

<CO 

•40 

— 

"5 

■*^   •* 

<    ► 

<s-  •*-  1-1  zs:                     s 

uj  •>  >-«m  — —  <x  •.                   q  «• 

a:z  —  •  <roo  <*z  —        QZ 

2:—  <o  —  •  1——  -3        <t— 

<Z— ^|Z— t\J  <Z         -  <Z^ 

UJ         . U-    •>-].-)  UJ         »Zw  LU         »  » 

ZZ^a»-Jif(r-ic\jU-  ZZH  • —  zZ^^i 

hhO  11  •-I—  11   *m  ho  h  i-*<  "-"O  11  11 

1—  .-*•— (  a.     i_i»0«^  t—<— 1«-»  11   11  1 — 1— <<— 1~^ 

Z3</7      rO»—      — (— Z  3t>0      -3— Z  ;3«/> 

ozo»  <ouj<oi    ozfof^'—cx:    czlolo 

ttTUJ^OSCMt—  SZ5       OCLU^iP-S    «0       OiUJc-^ 
COS  •■*  *-"t—  QCD2:       i-t      -tZHQffliO      Ol—  QCDX       <TQC:      <-*CCh-  C3CD3T  -JK-OCOZ: 

3hOO-UoOwUj^3wOwO«'OujZ3h  HO  II  lU^Di-.OUJaOccOUJZ3MOa-UJZr)>-iOQ 
WQQOl-,QQQUQ:lilWQCL)Q(JU^U.:(/)QOQClXUIl/)QQa;li.Q3U.oiUJtflQQQ(EQiLUwQQQ 


91 


AUX    (con't) 


oooooooooooooooooooooo 
o»  o  «-a  <nj  ro  .$■  in  >o  i*-  oo  o»  o  ^3  tv  i  m  •»}■  m  >o  (■-  oo  0s  o 
«j- in  ir>  to  in  in  ir»ir»  m  itmt>  vo  »o  no  o  o  vO  »o  »o  o  «o  r»- 
oooooooooooooooooooooo 
oooooooooooooooooooooo 
xxxxxxxxxxxxxxxxxxxxxx 


1/1  — 

-5  —      3T 


-5 

•>     II 

►     ii 

<     II 

•» 

<    •-• 

<       w 

a     » 

— 

o     — 

o    — 

<    — 

CO 

<x     ►-» 

<  — »-. 

LU       l— ' 

+ 

(JJ»  ■  —  — 

UJWw- 

a£—— . 

»-. 

«-. 

a:z<m 

oc-)<in 

a:s:< 

in 

"9 

>«-»«-.  • 

a——  • 

i — ■•«•> 

• 

•» 

<    o 

<    o 

< 

o 

IM 

UJ      ->t-t 

UJ      — ^ 

UJ      — 

p4 

•^ 

zzm"- 

ZZWli. 

Zzm 

U. 

< 

i-tO(Min 

«HO(f|^ 

»-tO<4- 

f*1 

II 

>-•-■  .— • 

H-i-h    •— 

i— «  ► 

*^ 

—2 

^u^>th-Z 

r)«/>c\ji-z 

3</V* 

1-2 

-)0C 

CZ~-<rot 

OZ-  <cC 

OZ*' 

<<X 

•3 

CtLUOS"^ 

QCujOS-j 

QCUJO 

xrs 

>-i|-ocDZ<a:i—  ocqz^qCi-o111^:*1 

a:i-o 

•—  uJZDmUJCUJZ- ImUJOluZJ1-"^ 

owz 

OCtUJl^OoCU-QCUJl^OOiULQLUJ^OOi      U.CCUJ 


m 


(*i 

m 

fn 

sC 

OJ 

m 

92 


CZHAT/CZHAT3 


ooo 

OOO 

ooo 
ooo 
<<< 

XXX 


ooooo 

ooooo 
ooooo 
ooooo 

<<<<c< 

mil 


OOOOo 
0>0_j<MfO 
Oi-Vtf-tf-4 

ooooo 
ooooo 
<r<r<<< 

uni 


OOO 
OOO 

ooo 
ooo 

XXX 


ooooo 

ooooo 
ooooo 
ooooo 

xxxxx 

OOOOO 


ooo 

0>0rl 

Ohh 
ooo 
ooo 

XXX 
OOO 


(\i 

CM 

CM 

CM 

* 

■*■ 

* 

* 

* 

* 

* 

# 

*^ 

^ 

mm 

^» 

• 

• 

• 

• 

in 

m 

in 

in 

.-> 

»-) 

«-4 

-4 

+ 

+ 

1 

+ 

ro     ro     ro     m 


*:    *z    >£    *: 

a    ^    ^    ^ 

X      X      X      X 


o 

Z 

H 

u 


x 


cm 

* 

O 


a 

H 


m 


< 
x 


CM 

CM 

CM 

CM 

* 

* 

* 

# 

* 

* 

* 

* 

«-» 

** 

*— 

*» 

• 

• 

• 

fl 

in 

in 

lf» 

in 

«■* 

»-« 

g-4 

»4 

+ 

l 

+ 

* 

Xm 

0>-J 

ST 

z^  * 

r-      O 
Z5ZC0 

ac-* 

QCS  II 

JUU4 


2:2:3:2: 

x:    ■*    x.    *c 

^    ^    ii    ^ 
xinxmxmxin 

— >      (OX      •—      •—      • 

«~o-»o«-o>«*o 

»■«■#•«■■«•*** 

-I— _J 1— _l— 

lu— uj— W'-uj- 
XMS^^c^cM 

>*#  ^#  "v*  "v* 

•  ■«■     •*    •■*    •# 

s^—  <p*~ .«-».-,„_).— 
II      •   II      •  II 

t—  in  i—  in,— 

X  +  -E  +  X 

—in—in—. 

■^jw  rvi—'fO 

oroso 

•  ^  •:*:  • 

hX«Xm 


t-l  +  l-l  +  e-l 


II   • 
ir\t-m 

m»in 

17-0      ••-* 

x»-*xr3 

*-- HQ 
+  N1  +  OtUJ 


E-t 
< 
33 
N 

u 


f-l 

« 

s- 

< 

^ 

X 

s 

-~ 

ft 

^ ■ 

*■* 

H 

m 

+ 

Eh 

IVj 

*■* 

h3 

•» 

CM 

D 

CD 

* 

S 

> 

♦ 

» 

«• 

3 

CO 

o 

H 

X       — 

X 

►      <f. 

1 

Q 

1-         w 

-^ 

W 

<r     co 

S"^ 

en 

X         ISJ 

«-■ 

D 

Ki          •> 

t-t 

*       ^* 

■z. 

i 

H-.           <J- 

X. 

w         «» 

■XL 

n 

CD 

X 

E-t 

ro    > 

«— 

< 

i-      •• 

— 

33 

<— ■ 

*-* 

N 

Xm«i- 

*m 

u 

M-»— 

**  • 

Or-^CO 

JO 

2-X 

LU-* 

UJj,/ 

>* 

2^2   • 

*v—» 

r—        w«Oi"'h 

►~>»^<VI 

ZDZi^«0—w 

^*Z 

oaZ^cdcDaD  li  *  at 

OtXUJ  ||  x> 

IVJI-— 3 

cc2  2:_i  ii  ii 

II  «<ot-o 

DUiiujOOOINUJZ 

WOQ>X>'*',sl  1  Q^LU 

93 


SUBROUTINE    CHROW 


ooooooo 

ooooooo 
ooooooo 
ooooooo 

inim 

ououuUu 


oooooooo 

00  <T<  O  .-a  k\j  ro  ^-  in 
O  O  r-lfH^i-ttH^ 

OOOOOOOO 
OOOOOOOO 

a  cc  cc  cc  cc  cc  cc  cc 

IIIIXHI 

OOOOOOOO 


O OOOOOOOO OOOOOOOO 

«o  h-  oo  cr>  o  «-o  cm  <o  <1"  in  >o  r—  oo  cr>  o  m<  r>  i 
»-« )^i-j  r-i  cm  rg  cm  <m  CM  (M  ci  <v  <v  cm  m  m  co 

ooooooooooooooooo 
oooooooooo ooooooo 

iiiiiiniiiiiiiii 

<_i  «J  O  O  <-<  <_i  O  O  O  O  <_>  O  <_/<->  o  o  o 


X      X 


X      2C 

x    x 


CM 

t\J 

CM 

CM 

* 

* 

* 

* 

* 

* 

* 

* 

in    in    in    in 


m     m     ro     ro 


M 

_ 

w 

~- 

s 

3T 

r 

»-4 

»-4 

•-4 

*4 

o 

O 

a 

s: 

x 

i. 

3EL 

z 

z 

<£. 

^ 

i«£ 

i£ 

SC 

LU 

UJ 

LU 

5^ 

^ 

^ 

*: 

o 

o 

o 

X 

X 

X 

X 

*v 

^ 

**. 

w 

M 

»»• 

~ 

*» 

■— 

-— 

«H« 

^^ 

«^ 

<^ 

• 

• 

• 

+ 

♦ 

+ 

+ 

in 

in 

in 

— 

«■» 

— . 

— 

<^4 

•-4 

»-4 

CM 

CM 

CM 

CM 

* 

■H- 

# 

* 

* 

■H- 

•»• 

»-4 

CM 

m 

-» 

# 

* 

* 

«■ 

< 

< 

< 

3 

«^ 

*^ 

*** 

^■» 

+ 

+ 

+ 

O 

• 

• 

• 

• 

CMf1^ 

— 

_. 

CC 

in 

IO 

in 

in 

ST5-Z 

r-4 

m 

m 

X 

»-j 

9-4 

1-4 

«-4 

ono 

"•* 

— 

— 

M  — in— -m— m~m 

—        -~        ,-eJ    ««H     »^4     •■_*     • 

3    in    wo— o«-o— o 

C— ■- »      »rf*^4*t-4*^l* 

am3  s#s-*s:*s:* 

x— 'O  *:— .*;— ^:— •*:-- 

U"^C<  s£— ii— ii— '  s£— • 

Si  xcmxcmXcmxcm 

l—        1— vO  II     •  II      •  II      •  II      • 

3Ztooo.-iinj\]mmin«*-m 
nOZ+^HtHr-iZH  •  •  • 
ccSai  no  +  o+o  +  o  i  — 4<-4~- 

(DZZJZ-2-Z-Z-  II   II   II 
3<-j>-'iuujinujmujmujtnr_j<Mcn 

i^(_)0>0~-Q'^0~0—  <<< 

^^       c^       ^^       e^ 


ujaiai  z  sr  s: 
oOo  x.  m  ^ 
ii  ii  n    •>«;  »>^  «^ 

ono  ■  ■ — •  i  ■ — ■  •  — ■ 

Z2Z  II"—  II  —  »-'  CM 

„-4UjuJuj«-'*cM*rn#  * 

2qQq<",<-< —  -4- 

O—— .»-— . _j— _j^-_ii-4rnin  •>  • 
zcMm^oJujfnuj^-ujX  x  xnjo 
uu  ••••>•>•>  II  II  II  II  II 
QOOOOSOVOV — ~5— 

ii  ujtuujuj  »lu  »uj  «^^rnin     "i-z. 

x    •    •    •    t^    tr^t    ♦«-4'-"^'w.^»»C£: 

Ommwhi».m»,mw332(M2D 

Z w~ll«»ll-llCOO      Ol-O 

LUU.U.U.LLii-JLLmtl.inoCCCctraQlUJZ 

Oh1- ••— "-•  XmXhi  ii  iqi  otuj 


CM 


CHROW  -  USED  IN  SINGLE  ARRAY  TRACKING 


94 


CHR0W3 


OOOOOOoOoOOOOOOO 

OOOOOOOOo»-)»-3r~J  .-<•-«  »-)^-S 
OOOOOOOOOOOOOOOO 
OOOOOOOOOOOOOOOO 
a.  cc  cl  cc  cc  cc  &■  a. a:  cc  a.  of  <*  cc  cl.  <x. 

IIIIIIIIIIIIIIII 

UOijUUOtOUUUUOUUU 


c 

I 

m 


Si 
X 


OJ 

*!■ 

rsl 

•m* 

•» 

CO 

CD 

r»i 

> 

•» 

•» 

-^ 

CO 

>* 

X 

%* 

■k 

CD 

3 

>- 

O 

■■ 

QC 

mm 

X 

•d- 

•■ 

>-^ 

l-« 

CD 

■— • 

X 

m 

m 

— . 

3 

in 

o- 

„w 

QClf>3 

x^o 

o«^ot 

5TX 

UJ^ 

ZiiZ    • 

mxOO 

C\J 

# 

# 

^ 

O 

> 

flMMf*»0Mt 

1 

5:^-2: 

«~ 

oco 

tM 

2ZZ 

w 

LULULU 

rH 

QDQ 

X 

>v>vV. 

^ 

i—  »^  ■■ 

*: 

OCO 

X 

X>-tvl 

■**> 

1  1  1 

«-» 

1.1  1      III 

+ 

t"»min 

— » 

IIW  1    «    II*     ^1 

CM 

s-4,-JI-J 

* 

zzz 

* 

i;^^ 

■"■ 

>^i«i^: 

O 

XXX 

X 

*****  »w 

1 

%*%■»  ^1 

*"• 

#*# 

i-l 

<■■  »^— fc 

»— 

— 1 — 1 1 

^4 

LuU-ltU 

£ 

>>><M 

i£ 

>^V.    . 

*: 

•   •   «<J- 

»— — ' O  ||   II   it  ||  -. 

I—        h^Oi— ll-i"— 1  — fl.  — -_— .— ,-J 

OXoooo~" — «-  II  -M-»-irfi^     — ^ 

OOST^cauDcCX  — .—■  ^—-rf^.-Xct 
OiXOI  II  X>nO-2S3N03 

ixis:2:_j^  ii  itzjsiooo    ct|_o 
-io-»iuancuj#  a:Qc.a:oxuJ2 


r- 

OJ 


CHR0W3  -  USED  IN  MULTIPLE  ARRAY  TRACKING 


95 


QFIND 

ooooooooooooooooooooooooooooooooooooo 
<^cvro^u^>Of^oD(T>0^<<\jfnstu^^rwoo^o»^ciros^ir\>cis-<i/0No^j(NJro«d-iAvor- 
ooooooooo^^g^t^r-i^^1^i^i^>^t^(\|Oi(vi{v<\j<\jicvjc\icj(\jrOfnrr>rCfOrnror'"> 

ooooooooooooooooooooooooooooooooooooo 
ooooooooooooooooooooooooooooooooooooo 

LLU_U.U-U-U_u_Ll.lJ_LLU-LLU_U-U-LLU_U_U-LLLLULU_U-l-l-a.U  U-U-1-l-U.U-lLLl.U  LLU. 

0000000000000000000000000000000000000 


—in 

a— 

-xz. 

<.*. 

■ 

•X 

ox 

0  - 

0— 

1— nn 

</i  ► 

»io 

>— 

*-**!. 

a* 

0 

(JQl 

0     0 

M     •> 

<5     0 

CO  — 

-<     0 

•*r> 

00     1—1 

0  - 

CM 

*ooo 

om 

* 

— O* 

<t— 

* 

CMO— 

0^ 

0m 

*>-iCM 

Ml 

«fr 

*  00* 

coi£ 

CM 

<M» 

CO** 

•^     in 

* 

J«£— 

-ao 

ida_     tH 

* 

^^ 

0m 

+  *  — 

— '  •» 

— 

x< 

r* 

OCQ  + 

0— .— c 

m      (M< 

x— 

< 

<_}  1  O                                                   "-1 

ZTininf- 

►      ** 

+  1- 

«» 

<<_>o                                           •■ 

*-*'»^      •* 

i-«       *><M 

CMOt 

\- 

00  <r                                     ,^— 

u-^mO 

11     o1-1*  0 

♦  a 

cc 

—>^<3           (MCM      CM<\j                      II  i-h 

OZw-ca 

->      UQ#    • 

*</) 

<_» 

ooc3>-«\i.-«o^^«-«I-sc^irirM     -?  •• 

*:a    m 

Q<OON 

— •'v 

00 

•Jt^lOOOuJ-W-UjQjUJllJUJUJLLI-J-      ~) 

LU>^      —  »o    •Oh"«->>» 

CM— 

>k 

— V*  **  CM*  *****  *    «*»-» 

zr  izHHHoi-nflO- . 

— 'CM- 

— «" •» 

-cm*  —  f»fr\«-imcMmcMCMcnc\ii-«MO 

nxo  •  11 

II  00— "-ICMCsJ 

^iw>l->J-CM*OCMUJ(J)Uje)<0<00<  II        II 

U_         l-HUJf-, 

C—  II    1100** 

^CMj./ii. 

v^« 

-*  *.  *  II   II   II  11  II   II   II  II  II   11  >-o— 

rszooz 

ooz  »o 

*omo<r^ 

*  #xx^^^:<<o»-icMcoj-cMm^m>4-<i-f~      »-tv: 

aC:ruji£»-3 

.-»<  ^O— <-3<<  it  xxxi«_  11 «—  *••»••••*»»•.  MM     .-O 

BJS'- 

— .(jmo  n  11 

11  11  t-i  11  xxx  11  cvj  11  i-»«-4t-i_}OJCMCMmro^        —t-a 

3»-"-iU.O 

0>^~*l-M.-«CVIfOt>JI<t  (T\ 

11  ■'  1 

l/)oQwQ 

i/jOC0O^>O<      <CCUD^UJUJOOQ(OOOOOOOQ          QCl-U 

0 

in 

T* 

ft 

f^ 

96 


LIST  OF  REFERENCES 


1.  NAVAL  TORPEDO  STATION  REPORT  1382,  NAVTORPSTA  3-D  RANGE 

COMPUTER  SOFTWARE  CONVERSION  PLAN,  J.  J.  Hirschf elder , 
November  1977. 

2.  NAVAL  TORPEDO  STATION  REPORT  1030,  Principle  of  the 

Three  dimensional  Range,  Revision  1,  Enclosures  (1) 
and  (2) . 

3.  Benson,  Eric  J.,  An  Application  of  Kalman  Filtering  To 

Underwater  Tracking,  Masters  Thesis,  Naval  Postgraduate 
School,  December  1976. 

4.  Mitschang,  George  W. ,  An  Application  of  Nonlinear  Fil- 

tering Theory  to  Passive  Target  Location  and  Tracking, 
PhD  Thesis,  Naval  Postgraduate  School,  June  197  4. 

5.  Kirk,  Donald  E.,  EE  4413  Optimal  Control  Systems  Class 

notes  (unpublished),  Naval  Postgraduate  School,  1975. 


97 


INITIAL  DISTRIBUTION  LIST 

No.  Copies 

1.  Defense  Documentation  Center  2 
Cameron  Station 

Alexandria,  Virginia   22314 

2.  Library,  Code  0142  2 
Naval  Postgraduate  School 

Monterey,  California   93940 

3.  Department  Chairman,  Code  6  2  1 
Department  of  Electrical  Engineering 

Naval  Postgraduate  School 
Monterey,  California   93940 

4.  Professor  H.  A.  Titus,  Code  62Ts  5 
Department  of  Electrical  Engineering 

Naval  Postgraduate  School 
Monterey,  California   93940 

5.  Professor  G.  L.  Sackman,  Code  62Sa  1 
Department  of  Electrical  Engineering 

Naval  Postgraduate  School 
Monterey,  California   93940 

6.  Commanding  Officer  5 
Naval  Underwater  Weapons  Engineering  Station 
Kayport,  Washington   983  45 

7.  Lieutenant  Dennis  M.  Dwyer  2 
4953  Klein  Court 

Woodbridge,  Virginia   2219  3 


98 


!SIS 


c.l 


/ 


Dwyer 


'9<i0l 


.Real    time  Kalman 
filtering  for  torr 
Pedo   range  track- 
ing. 

'3  0EC83  ■ 


W)  9  jM 


25   FEB   59 
21   KU   90 


SI  2366 

0397 
397' 

3552  1 

3588H 


Thesis 

D94 

c.l 


Dwyer 

Real    time  Kalman 
filtering  for  tor- 
pedo range  track- 
ing. 


v:si*oi 


lhesD94 

Real  time  Kalman  filtering  for  torpedo  r 


3  2768  000  98595  6 

DUDLEY  KNOX  LIBRARY 


